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NOMENCLATURE 


n Number  of  links  of  a manipulator, 

♦ Vector  of  actual  joint  position  parameters, 

♦ Vector  of  actual  joint  velocity  parameters, 

♦ Vector  of  actual  joint  acceleration  parameters, 
t Vector  of  desired  joint  position  parameters, 

t Vector  of  joint  position  parameters  of  reference 

St  Vector  of  deformations  in  joints, 

St  Vector  of  position  deviation  of  joints, 

A t Vector  of  velocity  deviation  of  joints, 

A t Vector  of  acceleration  deviation  of  joints, 

J$,  Position  of  actual  joint  axis  in  Plucker 
coordinates , 

Position  of  joint  axis  of  reference  system  in 
Plucker  coordinates, 

% Derivative  of  % with  respect  to  time, 

'3,  Derivative  of  'J,  with  respect  to  t, 

JT,  Transformation  matrix  for  actual  robot  manipulator 
system  from  the  i-th  coordinate  system  to  the  j-th 
coordinate  system, 

T,  Transformation  matrix  for  reference  system  from  the 


coordinate  system  to  j-th  coordinate  system, 


actual  manipulator  system 


velocity  of  link  i of 
relative  to  link  h expressed  in  the  j-th  coordinate 

Velocity  of  link  i of  reference  system  relative  to 
link  h expressed  in  the  j-th  coordinate  system, 
Jacobian  matrix  for  Vj  , 

Jacobian  matrix  for  ‘V' , 

Derivative  of  ' /,*  with  respect  to  time. 

Derivative  of  V*  with  respect  to  d , 

Linear  momentum  of  a rigid  body, 

Angular  momentum  of  a rigid  body. 

Total  momentum  of  a rigid  body. 

Inertia  matrix  of  link  i with  respect  to  the  i-th 
coordinate  system. 

Spring  constant  of  joint  i. 

Damping  coefficient  of  joint  i. 

Gravitational  force  acting  on  link  i expressed  in 
the  j-th  coordinate  system, 

External  force  acting  on  end-effecter  expressed  in 
the  j-th  coordinate  system. 

Inertia  matrix  of  dynamic  model  of  actual  system. 
Spring  coefficient  matrix  for  dynamic  model  of 
actual  system. 

Damping  coefficient  matrix  for  dynamic  model  of 
actual  system. 


Coefficient  matrix  of  centripetal  and  Coriolis 
acceleration  for  dynamic  model  of  actual  system. 
Total  gravitational  force  on  the  actual  system, 
Total  external  force  on  the  actual  system. 

Inertia  matrix  of  dynamic  model  of  reference  system. 
Spring  coefficient  matrix  for  dynamic  model  of 
reference  system, 

Damping  coefficient  matrix  for  dynamic  model  of 
reference  system. 

Coefficient  matrix  of  centripetal  and  Coriolis 
acceleration  for  dynamic  model  of  reference  system, 
Total  gravitational  force  on  reference  system. 
Total  external  force  on  reference  system. 

Inertia  matrix  for  the  quadratic  dynamic  model. 
Spring  coefficient  matrix  for  the  quadratic  dynamic 

Damping  coefficient  matrix  for  the  quadratic  dynamic 

Coefficient  matrices  for  second  order  terms  of  the 
quadratic  dynamic  model, 

Gravitational  force  for  the  quadratic  dynamic  model . 
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For  accurate  system  analysis  and  control  of  robot 
manipulators,  it  is  necessary  to  derive  adequate  nonlinear 
models.  The  system  nonlinearity  is  caused  by  several 
effects;  here  only  the  geometrical  reasons  are  being 
investigated.  This  thesis  presents  the  derivation  of 
explicit  nonlinear  models  and  the  utilization  of 
perturbation  methods  in  positional  and  dynamic  analysis  for 
rigid  serial  robot  manipulators. 

The  development  of  the  system  model  is  based  on  Plucker 
coordinate  representation.  The  vector  algebraic  operations 
in  this  notation  are  studied.  The  nonlinear  explicit  models 
are  derived  after  obtaining  power  series  expressions  for  the 
vector  of  joint  axis  position,  the  vector  transformation 
matrix,  and  the  Jacobian  matrix.  The  nonlinear  dynamic 


model  is  simplified  based  on  observations  of  the  dynamic 
response  of  a 3-R  manipulator,  resulting  in  quadratic 
equations.  There  are  two  second  order  nonlinear  terms  in 
the  quadratic  dynamic  model:  the  term  related  to  the 
centripetal  and  Coriolis  accelerations  and  the  term  for  the 
change  of  system  inertia.  A quadratic  model  for 
displacement  analysis  is  also  developed.  The  advantage  of 
using  this  positional  quadratic  model  is  a fast  convergence 
rate  in  associated  equations.  By  using  a perturbation 
method,  the  nonlinear  system  is  decomposed  into  a group  of 
sub-level  linear  systems.  Hence  this  technique  can  be  used 
to  derive  approximated  analytic  solutions  of  nonlinear 
systems,  but  here  it  is  only  used  to  find  numerical 
solutions.  For  reverse  analysis,  the  inverse  Jacobian 
matrix  must  be  obtained.  General  expressions  for  the 
inverse  Jacobian  matrix  have  been  developed,  which  keeps  the 
mapping  from  Cartesian  space  to  joint  space  invariant  under 
a change  of  coordinate  systems  and  a change  of  units. 
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INTRODUCTION 


Dynamic  modeling  for  robotic  systems  has  been  a 
favorite  topic  since  the  1960s  when  serial  manipulators  were 
first  studied  systematically.  Deriving  a dynamic  model  is 
the  first  step  for  investigating  mechanical  behavior  of  a 
manipulator  in  the  time  domain.  Robot  dynamic  modeling  is 
basically  divided  into  two  subtopics:  rigid  manipulator 
modeling  and  flexible  manipulator  modeling.  The  difference 
lies  in  whether  or  not  to  consider  the  deformation  of  links 
during  the  derivation  of  the  governing  equations.  Modeling 
for  rigid  robot  systems  had  its  heyday  in  the  early  80s 
[l,2,3,4],  and  the  major  application  realm  was  to  the 
industrial  robots  in  wide  use  at  that  time.  To  maintain  the 
rigidity  of  the  arms  it  is  necessary  to  have  sturdy  links, 
but  this  requirement  reduces  the  ratio  of  payload  to  robot 
mass.  On  the  other  hand,  the  dynamic  modeling  of  a light- 
weight manipulator,  often  called  the  "slim  robot",  should 
consider  the  flexibility  of  links.  This  leads  to  a more 
complicated  mathematical  model.  Development  of  a dynamic 
model  for  flexible  manipulators  has  adapted  a formalism  from 
those  for  rigid  body  manipulators  [5,6].  Hence  the  intense 


study  of  rigid  robots  will  also  benefit  flexible  robot 
systems. 

A robot  dynamic  model  is  not  only  used  for  purposes  of 
design  but  also  for  control  of  the  system.  Two  key  aspects 
for  evaluating  the  quality  of  a model  are  the  computational 
efficiency  and  convenience  of  implementation  for  controller 
design.  It  has  been  estimated  that  "real  time"  control 
requires  a controller  to  submit  sequential  commands  every 
0.02  seconds  (or  less)  [7,8].  This  figure  sets  a limitation 
for  model  derivation  and  algorithm  development.  For  both 
rigid  and  flexible  cases,  the  governing  motion  equations  are 
highly  nonlinear.  It  is  extremely  difficult  to  design  a 
nonlinear  controller  at  the  present  time,  and  the  question 
of  how  to  adapt  linear  control  to  a highly  nonlinear  system 
imposes  another  important  issue  in  robot  dynamics  and 
control.  Thus,  deriving  an  adequate  model  which  is 
efficient  and  manageable  is  a large  part  of  the  history  of 
robot  dynamics  and  control. 

The  governing  equations  for  rigid  body  manipulators  can 
be  derived  by  analytical  formulations  (Lagrange's  Equation) 
[2]  or  vectorial  formulation  (Newton-Euler,  Kane's  method) 
[1,3].  It  has  been  shown  that  there  is  no  fundamental 
difference  in  using  analytical  and  vectorial  methods  in 
formulating  the  dynamics  of  a system  [«].  Nevertheless,  the 
basic  equations  for  analytical  formulation,  such  as 
Lagrange's  equation,  are  primary,  and  manipulations  are 


needed  in  order  to  obtain  the  vector  equations  from  those 
for  analytic  formulation.  In  order  to  avoid  these  extra 
manipulations  in  deriving  governing  equations  it  is  wiser  to 
use  the  vector  formulation. 

No  matter  which  method,  analytic  or  vector,  is  used, 
the  same  type  of  motion  equation  results 

I*  + i'Q*  + Hi*  + c*  - F (1-1) 

♦,  * and  ♦ are  vectors  of  the  joint  instantaneous 
motion  parameter.  For  an  n link  manipulator,  the 
dimension  of  ♦,  ♦ and  i is  equal  to  n. 

I is  the  system  inertia  matrix,  with  dimension  n x n. 
♦'O*  represents  the  portion  of  inertia  force  due  to  the 
centripetal  and  Coriolis  accelerations;  every  entry  in 
the  term  is  of  second  order  in  ♦ , and  Q represents  the 
coefficient  matrix. 

KS*  represents  the  restoring  forces  in  joints  due  to 
the  deformations  of  the  joints. 

c$  represents  the  damping  in  the  joints  due  to  friction 

F is  the  external  force  exerted  on  the  manipulator, 
which  includes  the  payload  at  the  end  effector  and 
gravity  forces  on  links. 

The  matrices  I,  K,  c,  and  Q are  functions  of  *,  while  F is  a 
function  of  ♦,  ♦,  *,  and  time  t. 


The  nonlinearity  of  Eq. (1-1)  is  observed  from 

(1)  the  term  *'q*  is  second  order  in  ♦ , 

(2)  the  transcendental  functions  of  $ in  I,  K,  c, 
Q,  and  F,  which  create  high  order  terms. 

For  the  pure  translation  robot,  the  term  j'g*  and  the 
transcendental  functions  in  Z,  K,  c,  q,  and  F will  vanish. 
Rotational  motion  is  the  major  source  of  nonlinearity  for 
robot  systems. 

Modification  is  made  to  Eq. (1-1)  before  solution. 

Let  ♦ = 4 * A* 

Then  ♦ = 4 + A#  (1-2) 

♦ = * * 4* 

where  4,  4 and  4 are  the  motion  parameters  of  a pre-chosen 
state,  which  is  denoted  as  the  reference  system;  A 4,  A 4 and 
A 4 are  the  deviations  of  actual  motion  parameters  from  the 
reference  system.  Also  assume  that  only  linear  springs  and 
linear  dampers  exist  in  the  system.  Applying  a series 
expansion  about  4 for  I,  Q,  and  F,  manipulating  Eq. (1-1), 
and  then  neglecting  all  the  terms  of  A 4 with  order  higher 
than  1,  yields  a system  motion  equation  linear  in  A# 


IA 4 t Ca 4 t Ka 4 - F + 4'Q4 


1-3) 


where  I,  C,  K,  F,  and  Q are  coefficients  related  to  the 
parameters  of  the  reference  system. 

The  omission  of  the  quadratic  term  in  Ad  causes 
excessive  errors  in  Eq.(l-3),  and  this  phenomenon  has  been 
observed.  The  high  order  terms  of  Ad  are  insignificant  only 
when  Ad  is  small,  so  the  usable  region  of  Eq. (1-3)  is  a 
small  neighborhood  about  the  reference  system.  If  the 
accuracy  required  for  system  analysis  and  control  increases, 
the  usable  region  is  reduced,  more  reference  systems  need  to 
be  calculated,  and  the  burden  of  computing  coefficients  is 
increased.  Based  on  this  argument,  there  are  two  ways  to 
enhance  the  accuracy  or  to  decrease  the  time  of  computation: 

(1)  develop  an  efficient  algorithm  to  reduce  the  time 
needed  for  each  cycle  of  calculation  about  the 
reference  system. 

(2)  extend  the  usable  region  of  the  governing  equation 
for  each  reference  system. 

This  thesis  is  directed  towards  the  second  possibility: 
i.e.  to  develop  more  accurate  governing  equations  with  a 
larger  usable  region  of  Ad. 

Intuitively,  a more  accurate  model  (beyond  the  linear 
model)  is  obtained  by  keeping  the  higher  order  terms  of  Ad, 
Ad,  and  Ad-  In  this  work  we  start  from  a quadratic  model, 
in  which  the  second  order  terms  of  Ad,  Ad,  and  Ad  are  taken 


into  consideration.  The  system  governing  equation  will  then 
be  the  quadratic  differential  equation 

IA*  + CA*  + K&*  = F + tTQt 

+ A^'H.Ad  + A (I'M,  A#  + A0rH,Ad  + A^A*  (1-4) 

where  M,,  H;,  M3,  and  M,  represent  the  coefficient  matrices 
for  the  second  order  terms.  Effort  should  be  first  made  to 
derive  these  coefficient  matrices. 

In  the  process  of  equation  derivation,  kinematic 
representation  of  a link  and  its  transformation  from  one 
coordinate  system  to  another  play  important  parts.  There 
are  several  possible  representations  that  can  be  used,  such 
as  vector  representation  with  a 3 x 3 transformation  matrix 
[10,11],  homogeneous  coordinates  with  the  4x4  Denavit  - 
Hartenberg  transformation  [12,13],  Plucker  coordinates  with 
a 6 x 6 transformation  matrix  [14,15].  For  the  purpose  of 
compactness,  Plucker  coordinate  representation  is  used 
throughout  this  entire  work.  In  chapter  II,  the 
fundamentals  of  the  Plucker  vectors,  also  called  a spatial 
vector,  and  its  operations  are  reviewed.  Plucker 
coordinates  are  the  representation  of  a vector  in  a special 
vector  space.  The  reciprocal  product  of  vectors  in  this 
space  is  invariant,  contrary  to  the  invariance  of  inner 
product  in  a conventional  vector  space.  Introduction  of 


triple  vector  operations  will  benefit  the  derivation  of  non- 
linear motion  equations.  Then  in  chapter  III,  the  kinematic 
representation  of  a serial  robot  manipulator  by  Plucker 
notation  will  be  detailed,  and  there  will  be  a discussion 
about  the  difference  between  accelerations  and  the  change 
rates  of  velocity,  which  leads  to  different  forms  of  the 
motion  equations. 

To  study  a nonlinear  system  is  actually  to  deal  with 
the  system  parameters  and  its  motion  equations  under  the 
finite  perturbation  of  inputs.  In  chapter  IV,  efforts  will 
be  made  first  to  derive  the  expressions  for  the  perturbed 
joint  axis  $,  the  perturbed  transformation  matrix  T,  and  the 
perturbed  Jacobian  matrix  J under  finite  deviations  A#,  and 
then  to  derive  their  corresponding  perturbed  coefficient 
matrices  in  the  motion  equations,  such  as  I,  K,  C,  and  Q. 
Numerical  examples  are  used  to  show  the  improvement  in 
accuracy  of  representing  a perturbed  joint  axis  by  using  the 
quadratic  model.  In  the  last  part  of  chapter  IV,  a second 
order  approximation  for  the  motion  equation  will  be 
developed  based  on  the  perturbed  $,  T,  and  J. 

In  chapter  V,  application  of  the  quadratic  model  to  the 
dynamics  of  robot  manipulators  will  be  addressed.  A 
perturbation  method  is  chosen  as  a tool  to  solve  the  problem 
because  it  can  be  used  to  convert  a complicated  nonlinear 
system  to  a set  of  simple  sub-level  linear  equations,  and 


this  enables  one  to  apply  existing  techniques  to  study  the 
system.  Utilization  of  the  perturbation  method  to  the 
forward  dynamic  analysis  and  inverse  dynamics  will  be 
presented  after  a brief  review  of  the  technique  involved. 

A numerical  example  will  be  used  to  examine  the  influence  of 
the  second  order  terms  and  finally  to  lead  to  an  adequate 
form  of  the  non-linear  system  dynamic  model.  The  reverse 
positional  and  dynamic  analyses  are  based  on  an  approximate 
expression  for  deviations  in  joint  space  from  Cartesian 
coordinates,  which  is  obtained  after  deriving  the  general 
formulas  of  the  pseudo-inverse  of  the  Jacobian  matrix. 
Application  of  the  perturbation  method  for  position  analysis 
of  serial  robot  manipulators  will  also  be  addressed,  which 
is  followed  by  a illustrative  example.  In  chapter  VI,  there 
is  a discussion  of  the  work  presented  here  as  well  as 
suggestions  for  extended  future  tasks. 


CHAPTER 


P10CKER  COORDINATES  AND  VECTOR  OPERATIONS 

Plucker  coordinates  will  be  used  to  represent  position 
and  motion  of  rigid  bodies  as  well  as  the  forces  acting  on 
those  bodies.  The  use  of  Plucker  coordinates  greatly 
reduces  the  number  and  size  of  equations  required  to  express 
problems  which  need  to  be  solved.  Applications  of  Plucker 
coordinates  in  geometry,  kinematics,  and  dynamics  of 
mechanisms  and  robot  manipulators  have  been  made  by  Woo  and 
Freudenstein[16] , Featherstone [ 17 ] , and  other  researchers. 
Line  position,  velocity,  force  and  momentum  are  expressed  as 
six-dimensional  vectors  by  using  Plucker  coordinates. 

Plucker  coordinates  are  elements  of  a special  6-D  vector 
space  in  which  the  reciprocal  product  is  invariant  under  the 

we  are  familiar  with  is  one  in  which  the  inner  product  is 
invariant  under  its  rotation.  This  special  vector  space  has 
many  of  the  same  properties  as  those  of  the  ordinary  vector 
space.  Many  concepts  and  vector  operations  for  the  ordinary 
vector  space  can  be  directly  adapted  to  their  counterparts 
for  the  special  vector  space.  In  this  chapter,  there  is  a 


quick  review  of  Plucker  coordinate  representations  for 
motion  parameters  and  vector  operations  in  the  special 


2.1  Plucker  Coordinates  for  Line,  Velocity  and  Load 

(a)  The  position  of  a rigid  body  in  space  can  be  represented 
by  a line  and  a point  in  the  body.  The  position  of  a line 
in  space  is  determined  by  the  orientation  of  the  line  and 
the  position  of  a point  on  the  line,  as  shown  in  Fig. (2-1) . 
Let  B denote  a rigid  body  in  space. 

Let  L be  a line  in  the  body. 

Let  p be  a point  on  the  line, 

Let  xyz  be  a coordinate  system  at  point  o. 

Let  s be  a unit  vector  along  line  L,  s is 

expressed  in  the  coordinate  system  xyz, 

Let  r be  position  vector  of  point  p,  r is 

expressed  in  the  coordinate  system  xyz, 
then  the  Plucker  coordinates  of  line  L with  respect  to  xyz, 
denoted  as  are  given  by 


The  Plucker  coordinates  of  the  same  line  L with 
the  coordinate  system  x'y'z'  are 


where  s'  is  vector  s expressed  in  the  coordinate  system 
x'y'z',  and  r'  is  the  position  vector  of  p expressed  in  the 
coordinate  system  x'y'z'.  The  transformation  between  0 '$, 
and  °$,  is  accomplished  by  applying  a linear  matrix  T, 


(2-2) 

(2-3) 


where  T is  of  dimension  6 by  6,  R is  a 3 by  3 rotational 
transformation  matrix  from  to  x'y'z'  to  xyz,  and  II,  is  a 3 
by  3 zero  matrix,  d'  is  the  position  vector  of  the  origin 
of  coordinate  system  x'y'z',  o'  expressed  in  the  system  xyz. 
(d'x]  is  a 3 by  3 anti-symmetric  matrix  which  represents  a 
mapping  associated  with  d1.  The  mapping  is  defined  by 


components : 


(b)  Rigid  body  motion  consists  of  two 
rectilinear  motion  and  rotational  motion.  The  velocity  of  a 
rigid  body  can  be  represented  by  the  linear  velocity  of  a 
reference  point  in  the  body  and  the  angular  velocity  of  the 
body,  as  shown  in  Fig. (2-2) . 

Let  xyz  be  a fixed  coordinate  system  at  point  o, 

Let  x'y'z*  be  a fixed  coordinate  system  at  point  o', 

Let  u be  the  angular  velocity  of  body  B expressed  in 


Let  l)„  be  the  linear  velocity  of  a point  in  the  body 
coincident  with  o and  be  expressed  in  xyz; 
then  the  Plucker  coordinates  of  velocity  of  the  point  in  the 
body  coincident  with  o,  denoted  by  °V,  is  expressed  by 


Also  for  the  velocity  at  point  o ' , one  has 


where  «'  is  the  angular  velocity  of  the  body  expressed  in 
system  x'y'z',  u0'  is  the  linear  velocity  of  the  point  in 
the  body  coincident  with  o'  and  expressed  in  system  x'y'z'. 
The  two  sets  of  coordinates  °V  and  0 V are  related  by 


T °V 


where  T is  the  transformation  matrix  defined  in  Eq. (2-3) . 


(c)  When  a generalized  external  load  is  applied  to  a rigid 
body,  it  produces  a force  and  a moment  with  respect  to  a 
point  in  the  body,  as  shown  in  Fig. (2-3).  Then  the  Plucker 
coordinates  of  load  at  point  o,  denoted  by  °F,  are  given  by 


where  t is  the  moment  at  point  o expressed  in  xyz,  and  f is 
the  force  on  the  body  expressed  in  xyz.  Also,  for  the  load 


where  t'  is  the  equivalent  moment  at  point  o'  expressed  in 
x'y'z',  and  f‘  is  the  force  on  the  body  expressed  in  x'y'z'. 
The  relationship  between  °F  and  0 F can  be  expressed  by 


The  Plucker  coordinates  for  position,  velocity  and  load 
have  the  same  transformation  matrix.  Therefore,  these  three 


parameters  can  be  regarded  as  vectors  in  the  same  vector 

The  properties  of  a vector  space  depend  upon  the  form 
of  the  transformation  matrix  which  maps  the  vectors  onto 
themselves.  The  transformation  matrix  of  ordinary  vector 
space  defined  above  is  an  orthonormal  matrix,  and  the  inner 
product  of  two  vectors  in  the  space  is  invariant  under  the 
transformation. 

However,  a vector  space  with  transformation  matrix  T 
expressed  by  Eq. (2-4)  has  different  properties:  the 

transformation  matrix  T is  not  an  orthonormal  matrix,  and 
the  inner  product  of  two  vectors  in  the  space  is  not 
invariant  when  associated  with  the  transformation  T.  If 
concepts  associated  with  a vector  inner  product  are  still 
used  to  investigate  this  special  vector  space,  extra  effort 
must  made  to  map  this  space  to  an  ordinary  vector  space. 

By  carefully  studying  the  transformation  matrix  T of 
the  special  vector  space,  one  can  find  that  each  column 
vector  in  T is  reciprocal  to  itself  and  four  other  column 
vectors  (which  will  be  shown  later) . This  particular  matrix 
will  be  referred  to  as  a reciprocal  matrix.  A vector  space 
which  has  a reciprocal  transformation  matrix  and  is 
reciprocally  invariant,  will  be  defined  as  a reciprocal 
vector  space.  By  using  the  reciprocal  product  instead  of 
inner  product,  many  theories  and  vector  operations  for 


ordinary  vector  space  can  be  directly  adapted  for  the 
reciprocal  space. 

For  ordinary  vector  space,  three  major  vector 
operations  have  the  following  properties: 

Let  B be  an  ordinary  vector  space  of  dimension  3, 

let  U[,  U; , and  U3  be  three  vectors  in  the  vector  space. 

for  vector  cross  product, 

U,  X Uj  - - Oj  X 0,  (2-13) 

for  vector  triple  scalar  product, 

°1  • °2  x U3  = U3  • U3  x U,  (2-14) 

U,  • U2  x 03  - U,  x 03  • U3  (2-15) 

for  vector  triple  cross  product, 

0,  x (U3xU3)  = (UjXU,)  X 03  - (UjXU,)  X U3  (2-16) 

Their  corresponding  vector  operations  in  the  reciprocal 
vector  space  have  the  same  properties  as  those  in  ordinary 
vector  space.  The  similarities  in  vector  operations  will  be 
stated  after  a review  of  the  properties  of  the 
transformation  matrix  T.  All  their  proofs  of  the  are  given 
in  the  Appendix  1 to  5. 


Z--2  Reciprocal  Space  and  its  Vector  Operations 


(a)  Reciprocal  Product  and  Reciprocal  Transformation  Matrix: 


reciprocal 


The  reciprocal  product  of  $,  and  $.  is  defined  as 

$,  o $2  = X4(x,  + Is/ij  + XjMj  + X,(J,  + XzM5  + X^  (2-17) 
S;  and  S,  are  said  to  be  reciprocal  to  one  another  if 


the  reciprocal  multiplication  of  T,  by  is  defined  as 


Let  T be  the  transformation  matrix  for  the  reciprocal 
vector  space.  Then  the  reciprocal  multiplication  of  T and 
its  transpose  is  a 


special  'identity  matrix 


Hence  one  can  see  that  the  transpose  of  T is  its  'reciprocal 
inverse',  denoted  as  T1  ■ T"1,  and  that  T is  a reciprocal 


reciprocal  matrix  T.  From  Eq. (2-20) , one  can  obtain 


(b)  Vector  cross  product: 

Let  $,  and  $2  be  two  vectors  in  a reciprocal  vector 
space,  let  8. , s2,  s10,  and  B?0  be  vectors  of  dimension  3. 
$i  and  5,  can  be  expressed  by 


The  cross  product  of  ?,  and  $2  is  defined  by 


(2-21) 


According  to  Eq. (2-4)  for  the  napping  related  to  the  cross 
product  operation  in  a 3-D  vector  space,  the  element  in 
Eq.  (2-21),  8,xs,  can  also  be  expressed  by  [S,x)s?.  So,  too, 
can  the  elements  8,0xs2  and  S|XS2g.  Then 


r (b,x)  o3 

[ [810x]  ts,x; 


The  mapping  associated  w 
denoted  by 


L C810X]  (S,x]J 


The  cross  product  o 
distributive  law 


o vectors  satisfies  t 


i -commutative  1 


e Appendix  2.)  (2-2S) 


(2-26) 


(c)  Triple  Scalar  Product 

Let  $2,  and  $3  be  three  vectors  in  a reciprocal 
vector  space.  The  triple  scalar  product  of  the  vectors  has 
the  following  properties 

5,  0 5,  e 5,  = 5,  0 Sj  ® $,  (2-27) 


$,  0 $2  ® $ 3 = $,  ® e $3  (see  Appendix  3.)  (2-28) 

Hence  the  sign  of  the  triple  scalar  product  changes  when  two 
vectors  interchange,  while  the  sign  of  the  triple  scalar 
product  is  preserved  when  the  operations  o and  ® 
interchange. 

!f  Si,  $2,  and  $3  denote  three  lines  in  a Cartesian 
space,  then  the  vanishing  of  the  triple  scalar  product  of 
the  three  vectors  indicates  specific  geometrical 
arrangements  among  the  three  lines.  For  instance,  when 
three  lines  meet  at  a point  in  space,  their  vector  triple 
product  equals  zero. 


(d)  Triple  Cross  Product: 

Let  $3,  and  $3  be  three  vectors  in  a reciprocal 
vector  space.  The  triple  cross  product  of  $,,  $2,  and  S3  has 
the  following  property 

Si  ® - ($3®$,)  ® $3  - ($3®$,)  ® $3  (2-29) 

(see  Appendix  4.) 


(e)  Invariance  of  operations: 

In  a reciprocal  vector  space,  the  reciprocal  product  is 
invariant  under  linear  transformation 

$i  o $j  = (T  $,)  o (T  $j)  (see  Appendix  5.)  (2-30) 

where  $,  and  $?  are  vectors  in  the  reciprocal  space. 

The  above  result  can  also  be  extended  to  multiple 
linear  operations  which  are  associated  with  reciprocal 
product,  such  as 

invariant  triple  operation 

S,  o S,  e S3  ■=  (T  $,)  o (T  $z)  e (T  $3)  (2-31) 

invariant  quadruple  operation 
S,  o $?  e [$j  s $,] 

= (T  $,)  0 (T  $z)  ® [<T  $3)  e (T  $,)]  (2-32) 

S,  0 ($2  ® $3]  e $s 

= (T  $,)  o [(*  S2)  0 (T  $3)]  0 (T  $4)  (2-33) 

(S,  ® Sj)  0 (S3  ® S4) 

= [{T  ® (T  $Z)J  O [(T  $3)  ® (T  $,)]  (2-34) 

The  multiple  vector  operations  and  their  invariance 
provide  useful  mathematical  tools  for  deriving  system 
dynamic  nonlinear  models. 


Fig. (2-1)  Position  of  a 


Fig. (2-2)  Velocity  of  a rigid  body  at  two 
different  points 


Fig. (2-3)  Effect  of  load  on  a rigid  body  at 
different  points 


CHAPTER  III 

KINEMATIC  REPRESENTATION  OP  SERIAL 
ROBOT  MANIPULATORS  AND  MOTION  EQUATION  FOR  LINKS 

This  chapter  introduces  notation  and  reviews  the 
Plucker  coordinate  representations  for  the  motion  of  serial 
robot  manipulators.  For  further  understanding,  refer  to 
some  related  books  and  literature  [17,18]. 


3.1  Coordinate  systems 

Serial  robot  manipulators  are  mechanisms  with  serial 
f links  and  lower  pair  joints  (revolutes  and 
prismatics) , as  shown  in  Fig. (3-1, aj . Local  coordinate 
systems  X,Y,Z,,  for  i=l, 2, ...n,  are  set  up  for  every  link. 
Their  Z axes  are  colinear  with  respective  joint  axes,  and 
the  X axes  are  parallel  to  the  common  normal  of  two 
consecutive  axial  lines,  as  indicated  in  Fig. (3-1,  b) , wher 


coordinate  system, 
coordinate  system. 


o'i.jO,  is  the  common  normal  of  axis  and  axis  $. , 
o' |0(,[  is  the  common  normal  of  axis  $,  and  axis  $m, 

L,  is  referred  to  as  the  length  of  link  i,  which  is  the 


distance  between  axis  S,  and  axis  i.e. , L,  is 

the  length  of  the  line  o'jOl(I 
a,  is  referred  to  as  the  offset  of  link  i , and  is  the 

0,  is  the  twist  angle  from  $w  to  $,. 

If  joint  i is  a revolute,  5,  will  be  the  parameter  related 
to  rotational  input,  while  if  joint  i is  a prismatic  joint, 
a,  will  be  the  parameter  related  to  linear  input.  A global 
coordinate  system  Xoy0Z„  for  the  manipulator  is  fixed  to  the 
ground;  usually  the  axis  ZD  is  colinear  with  $,. 

3.2  Position  of  Joint  Axes  and  Transformation  Matrices 
The  position  of  joint  axis  $,  with  respect  to  the  j-th 
local  coordinate  system  is  denoted  as  3$t,  and  expressed  by 
6-dimensional  Plucker  coordinates.  The  coordinates  of  $, 
with  respect  to  its  local  coordinate  system  are 

([  001000  ]T  for  revolute  joint 
( 000001  ]T  for  prismatic  joint 

The  transformation  from  the  i-th  coordinate  system  to  the 
j-th  coordinate  system  can  be  accomplished  by  multiplying  by 
a transformation  matrix  JT,.  It  is  expressed  as 

J$,  = (3-1) 

From  Eg. (2-3),  the  transformation  matrix  can  be  written  as 


1-2) 


tJa,K]JR, 


where  JR,  is  the  3 by  3 rotation  matrix  from  the  i-th 

coordinate  system  to  the  j-th  coordinate  system, 
o3  is  a 3 by  3 null  matrix, 
d*  is  the  vector  from  the  origin  of  the  j-th 
coordinate  system  to  the  origin  of  the  i-th 
coordinate  system, 

Jd,  is  the  coordinates  of  d,  in  the  j-th  coordinate 

From  the  previous  chapter,  JT,  is  a reciprocal  matrix,  and 
has  the  property  T'1  = T1.  For  one  has. 


where  'R.,,  is  an  orthonormal  matrix,  1 R . . = R . , . 


substituting  Eg. 


1-4)  ii 


Eg. (3-1),  yields 


1-6) 


3.3  Link  Velocity  and  Jacobian  Matrix 
The  velocity  of  a rigid  body  is  a relative  quantity 
with  respect  to  a reference  rigid  body.  It  includes  the 
relative  angular  velocity  of  the  body,  u,  and  the  relative 
linear  velocity  of  a point  in  the  body,  u.  The  relative 
velocity  can  be  expressed  in  any  one  of  the  coordinate 
systems  (local  or  global)  of  the  manipulator.  So  the 
velocity  of  link  i with  respect  to  link  j expressed  in  the 
h-th  coordinate  system,  denoted  as  "v,1,  is  given  by 


V,*  is  the  relative  velocity  of  link  i to  link  j at  a point 
in  link  i coincident  with  oh,  the  origin  of  the  h-th 
coordinate  system,  as  shown  in  Fig. (3-2) . The  velocity  of 
link  i relative  to  link  k expressed  in  the  same  coordinates 
h will  be 


where  the  second  term  in  Eq. (3-8)  is  the  relative  velocity 
of  link  j with  respect  to  link  k. 


obtain 


MV,M  - t,  (3-9) 

and  V,1'1  = "T,.,  ‘‘‘v,1'1  = h$,  t, 

where  0,  is  the  generalized  input  velocity  of  joint  i 
for  a revolute  joint  and  #,=a,  for  a prismatic  joint) . 

V - Si1  + + ••••  * V' 

therefore,  one  can  write 


= KJ,J  ♦ (3-10) 

where  ♦=[),),  ....  j,  ]'  is  the  input  vector,  and  "j,1  is 
referred  to  as  the  Jacobian  matrix  which  maps  the  joint 
velocity  onto  the  velocity  in  Cartesian  coordinates.  The 
velocity  of  link  j relative  to  link  i is  equal  and  opposite 
to  the  velocity  of  link  i relative  to  link  j.  Hence 

V = -V  = -hJ,J  * 


(3-11) 


The  relative  velocity  with  respect  to  the  m-th 
system,  "v,1,  can  be  obtained  by  pre-raultipling 
transformation  matrix  with  V,1 


coordinate 


*$w  ...  "Sj  0 ...  0 ] (3-12) 


3.4  Change  Rates  of  Vector  and  Acceleration 
The  study  of  change  rate  of  a vector  with  respect  to 
time  can  be  found  in  relevent  publications  [14,15].  There 
elegant  expressions  for  change  rate  of  vectors  were 
developed;  then  by  applying  the  momentum  conservation  law, 
the  motion  equation  for  a rigid  body  can  be  obtained.  The 
change  rate  of  velocity  studied  in  the  literature  [14,15] 
different  from  the  acceleration  of  a rigid  body. 
Conceptually,  the  acceleration  belongs  to  another  type  of 
change  rate  of  velocity.  Investigating  the  relationship 
between  the  change  rate  of  velocity  and  the  corresponding 
acceleration  helps  one  to  further  understand  the  physical 
concepts  of  both  change  rates  of  a vector.  In  this  sectioi 
the  derivation  of  change  rates  for  a position  vector  $ is 
given  first  because  it  is  easily  visualized  and  easily 
understood.  The  results  will  be  applied  to  other  vectors  : 


velocity 


transformation  matrix  as  $ does.  The  detailed  expressions 
for  the  change  rates  of  a vector  will  be  obtained  after 
deriving  the  expression  for  the  change  rate  of  the  Jacobian 

First,  notation  needs  to  be  defined: 

1.  (’)  denotes  the  derivative  of  the  variable  in  parenthesis 
with  respect  to  time; 


(’)  has  the  same  dimension  as  ( ) does. 

2.  (')  denotes  the  derivative  of  the  variable  in  parenthesis 


if  ( ) is  dimension  m,  (')  will  be  dimension  mxn. 

3.  ( ) denotes  the  time  rate  of  change  of  a variable  at  a 

point  fixed  to  the  base  coordinate  system. 

4 . ( * ) denotes  the  time  rate  of  change  of  a variable  at  a 

point  in  the  moving  body. 

{')  and  C)  are  term-wise  derivatives,  while  (’)  and  (’)  are 
the  overall  derivatives  of  the  variable.  The  difference 
between  ( ) and  {*)  can  be  seen  from  Fig. (3-3) : coordinate 

system  0 is  the  base  coordinate  system,  coordinate  system  o' 
is  fixed  to  the  moving  body  B.  At  instant  t,,  point  o and 
o'  coincide;  then  o'  will  move  away  from  o as  the  body 
moves.  D,  is  a vector  of  a point  in  body  B coincident  with 
o at  instant  t, ; while  at  instant  t,,  u2  and  D? ' are  the 


vectors  at  points  of  B coincident  with  o and  o' 
respectively.  Therefore,  (6)  and  (ft)  can  be  expressed  as 


According  to  the  above  argument,  (U)  is  defined  as  the 
change  rate  with  respect  to  a fixed  point  while  (6)  is 
defined  as  the  change  rate  with  respect  to  a moving  point. 

Let  $ be  the  axis  of  joint  i,  let  0,  represent  a 
coordinate  system  fixed  to  link  i,  and  let  oi  represent  a 
coordinate  system  fixed  to  link  j,  as  shown  in  Fig. (3-4). 
Knowing  the  velocity  of  link  i relative  to  link  j at  point 
o,,  denoted  as  u and  'v,  find  the  change  rates  of  $ with 
respect  to  time  in  coordinate  system  0,.  Keeping  in  mind 
that  the  problem  deals  with  link  i and  its  relative  motion 
with  respect  to  coordinate  system  O,,  one  can  temporarily 
take  off  some  of  the  corresponding  subscritps  and 
superscripts  and  keep  only  the  superscripts  for  point 
indication  during  the  following  equation  manipulation. 

The  Plucker  coordinates  of  $ in  0 are 


Talcing  the  overall  derivative  of  the  above  equation  with 
respect  to  time  yields  its  change  rate  at  a fixed  point 


Using  the  formula  for  differentiation  of  a 3-D  vector,  one 


d is  the  relative  linear  velocity  of  link  i at  point  o,  with 
respect  to  coordinates  os  and  is  given  by 

Substituting  Eq. (3-14)  and  (3-15)  into  Eq. (3-13) , yields 


l (Ju+«xd)  xs+dx(oxs)  J 
By  utilizing  Eq. (2-16) , one  can  obtain 
(oxd)xs  ■ ux(dxs)  - dx(uxs) 


JDxs+ux(dxs)  J 


JV  e ‘$ 


(3-16) 


Nevertheless,  the  relative  linear  velocity  between  o,  and 
the  point  in  link  i coincident  with  Oj  can  be  expressed  as 

8 = u x d (3-17) 

because  the  distance  between  two  points  fixed  in  a rigid 
body  does  not  change.  Using  a instead  of  d,  the  change  rate 
of  a moving  point  for  J$  is  given  by 

- I 

l ux(dxs) 


1 U 

= ‘a  e (3-is) 


It  is  noticed  that  the  difference  between  ’$  and  JS  is  due 
to  the  relative  velocity  of  the  point  in  link  j (coincident 
with  Oj  in  link  i)  with  respect  to  j-th  coordinate  system. 
So  at  the  instantaneous  center  of  velocity,  J$  = J$. 

The  velocity  of  the  point  in  link  i coincident  with  Oj, 
V can  be  expressed  as 


[ux]  03 

03  [«x) 


Applying  the  sane  techniques  as  those  for  finding  J$  and 
the  two  types  of  change  rates  for  Jv  can  be  obtained 


(3-19) 

(3-20) 


Equation  (3-19)  indicates  the  relationship  between  the 
change  rates  of  velocity  at  a fixed  point  with  respect  to 
different  coordinate  systems.  They  transfer  to  one  another 
by  simply  multiplying  by  a transformation  matrix 

"v  - "t,  'v 

*y  = JT,  'v  = JT„  "t,  'v  ■ JTh  "v 
Utilizing  Eq. (3-19)  on  a manipulator  system  yields 


where  'v,h  is  the  change  rate  at  a fixed  point  of  the 
relative  velocity  of  link  i expressed  in  coordinate  system 
o,.  ' V , n is  the  change  rate  at  a fixed  point  of  the  relative 

velocity  of  link  i expressed  in  coordinate  system  Oj . The 
relative  velocity  of  link  i with  respect  to  link  h is  the 
sum  of  the  two  relative  velocities 

V,h  - y + \h  (3-22) 

Their  corresponding  change  rates  also  satisfy  the  additional 
relation 

However,  it  should  be  emphasized  that  this  change  rate  of 
velocity  at  a fixed  point  is  not  the  conventional 
acceleration  which  can  be  directly  applied  to  the  Newton- 
Euler  equation. 

in  Eq. (3-20)  is  the  change  rate  of  velocity  for  a 
moving  point  in  link  i.  It  is  the  relative  acceleration  of 
link  i with  respect  to  the  j-th  coordinates  at  a point  in 
link  i coincident  with  or  Utilizing  Eq. (3-20)  on 
manipulator  systems  and  using  notation  a instead  of  , 
yields  the  general  formula  for  relative  acceleration  of  link 


i of  manipulators 


The  relative  acceleration  expressed 


coordinate  system 


(3-24) 


To  calculate  JV11'  and  Ja,h,  J’v,h  should  be  found  first. 
From  Eq. (3-10) , the  relative  velocity  of  link  i can  be 
obtained 


Differentiating  the  above  equation  yields 

JV,B  = 1J,h  ♦ + Ji,h  ♦ (3-25) 

since  V,*  = JV,"  = 1J,h  * + JJ,h  ♦,  one  obtains 


The  expression  of  the  Jacobian  matrix  has  been  written  as 

V - ( 0 ••  0 Vl  0 0 1 

then  Jj,h  = [ 0 . . 0 J$,  0 0 ) (3-27) 

From  Eq. (3-16) , one  has 


]8,  = V,1  ® >8, 


J-28) 


Applying  the  anti-commutative  law  of  the  vector  cross 
product  to  Eg. (3-28)  yields 

JJ,  - - J8,  e V,1 

= - CJS,® ] JJ,J  ♦ (3-29) 

Also  J8,  can  be  expressed  as 

J8,  = -gf-  = * (3-30) 

where  )S,  = - [JS,0]  (3-31) 

Substituting  Eg. (3-30)  into  Eg.  (3-27)  and  referring  to 
Eg. (3-26) , yields 

Jj,*’  - [ 0 ..  0 JSh<!i  ...  J8|*  0 ...  0 ) (3-32) 

If  Eg. (3-32)  is  rewritten  as 

then,  Jj,h  is  defined  as 

and  Jj,h  = Jj,h  ♦ (3-34) 

As  a summary  and  generalization  of  the  above:  let  o be 
a vector  in  6-space  with  a transformation  matrix  represented 


by  Eq.  (3-2) , let  V be  the  relative  velocity  of  D with 
respect  to  the  j-th  coordinates,  and  1 0 be  the  relative 
angular  velocity  of  U with  respect  to  the  j-th  coordinates; 
then  the  two  types  of  change  rates  of  D with  respect  to  the 
j-th  coordinates  can  be  expressed  as 


They  have  the  following  properties: 

'#  t 'Tj 

At  the  instantaneous  velocity  center  of  D with  respect  to 
j-th  coordinate,  jU  = J0 


3,5  Derivation  of  Motion  Equations 
There  are  several  methods  for  developing  notion 
equations.  They  can  be  characterized  as  the  energy-work 
method,  the  momentum-impulse  method,  and  the  acceleration- 
force  method  etc.  As  pointed  out,  the  momentum  of  a moving 
rigid  body  is  a vector  in  linear  space  and  its  change  rate 
at  a fixed  point  with  respect  to  time  satisfies  Eq. (3-35) . 

By  utilizing  the  momentum  conservation  law,  the  motion 
equation  can  be  obtained.  Alternatively,  one  may  first  find 
the  acceleration  for  the  mass  center,  then  directly  apply 


the  Newton-Euler  equation.  These  two  types  of  motion 
equations  are  equivalent;  the  choice  is  based  on 
convenience.  However,  the  formula  from  the  momentum- impulse 
method  will  be  used. 

Let  p denote  the  linear  momentum  of  a rigid  body 


where  ■ is  the  body  mass,  and  cu  is  the  linear  velocity  of 
the  mass  center  oe.  Let  p0  denote  the  angular  momentum  of 
the  body  about  its  mass  center,  then 

Let  P,  denote  the  total  momentum  of  the  body  with  respect  to 
the  mass  center.  Pc  includes  both  linear  and  angular 
momenta,  and  it  can  be  expressed  as 


= Ic  ‘v  (3-36) 

The  momentum  of  the  body  with  respect  to  point  o,  as 
shown  in  Fig. (3-5) , is  given  by 


[«C*) 


- °TC  Pc  (3-37) 

where  the  term  dcx«cu  denotes  the  additional  part  of  angular 
momentum  due  to  the  change  of  reference  point  from  point  c 
to  point  o,  and  °TC  is  the  transformation  matrix  from  c to 
o.  Furthermore,  one  can  rewrite  Eg. (3-37)  as 

P = °TC  Ij'V  = °TC  Ic  CT„  (°TC  CV) 

= ( °TeIccT0  ) °V  = I„  °V  (3-38) 

where  "Tj'v  = °v,  °V  is  the  velocity  at  point  o, 

°TCICCT0»I0,  i0  is  the  inertia  matrix  about  point  o. 

Equation  (3-38)  represents  the  general  formula  for  total 
momentum  of  a rigid  body. 

It  is  shown  in  Eq. (3-38)  that  transformation  of 
momentum  P among  different  points  in  a rigid  body  can  be 
accomplished  by  multiplying  by  a transformation  matrix. 

Hence  Eq. (3-35)  can  be  used  to  derive  the  change  rate  of  P 
with  respect  to  time.  By  referring  to  the  procedures  for 
finding  the  change  rate  of  velocity,  one  can  derive 


where  (I  V)  is  the  derivative  of  P with  respect  to  time. 
Since  the  moving  coordinate  system  0 is  fixed  to  the  rigid 
body,  I is  constant;  therefore 


Equation  (3-39)  is  valid  for  any  point  in  the  rigid  body. 

For  the  mass  center,  the  change  rate  of  momentum  is  given  by 

Pe  = It  4 + “V  « Ifv  (3-40) 

and  P0  = °tc  Pc  (3-41) 

Equation  (3-41)  indicates  that  the  change  rate  of  momentum 
of  a rigid  body  is  also  transferable  like  the  change  rate  of 
velocity. 

By  applying  the  momentum  conservation  law,  the  motion 
equations  for  a rigid  body  in  Plucker  coordinates  can  be 
obtained 


where  P is  the  sum  of  all  forces  and  moments  applied  on  the 
body,  V is  the  velocity  of  the  body  expressed  in  fixed 
coordinates. 

However,  using  the  Newton-Euler  equation,  one  can  also 
derive  the  motion  equation.  The  compact  form  of  the  Newton- 
Euler  equation  in  Plucker  coordinates  about  the  mass  center 
can  be  expressed  as 


(3-4 


of  which  the  original  six  detailed  equations  for  linear  and 
angular  motions  can  be  found  in  textbooks  on  the  dynamics  of 
rigid  bodies.  Another  form  of  motion  equation  for  the  mass 
center  based  on  the  momentum-impulse  method  can  be  obtained 
by  referring  to  Eq. (3-42) 

Fc  = I.'V  + “V  8 IC°V  (3-44) 


As  mentioned  before,  Eq. (3-43)  and  (3-44)  are  actually  the 
same.  The  equivalence  of  the  two  equations  can  be  proven  as 
follows:  referring  to  Eq. (3-24) , one  has 


Substituting  ca  into  Eq. (3-43)  yields 


Fc  = lc  (cV  + QacV)  + Qs  Ic0 


= I,**  + Ic0  s 'V  + 0 « Ie0 
If  one  can  show 


Icn  8 “V  + Q 8 ICQ  = tV  8 ICCV 


then  the  proof  is  accomplished. 


(«x) 


Although  the  proof  above  is  made  for  two  forms  of 
motion  equations  about  the  mass  center  of  a rigid  body,  t 
result  is  also  applicable  for  any  point  in  the  body.  So 
general  forms  of  motion  equations  for  rigid  body  will  be 

where  terms  in  the  equation  are  transferable 


(2)  P = I a + Q ® 10  (3- 

where  terms  in  the  equation  are  not  transferable 


Eg. (3-43)  is  chosen  as 


formula  for  developing  the  system  dynamic  models, 
links  in  robot  manipulators.  Eg. (3-43)  will  become 


<b) 

Fig. (3-1)  Kinematic  sketch  of  serial 
manipulators 


Fig. (3-2)  Relative  velocities  between  link  i 
and  link  j 


Fig. (3-3)  Vector  field  of  a moving  body 


Fig. (3-4) 


change 


Fig. (3-5)  Momentums  of  a rigid  body 


CHAPTER  IV 

DERIVATION  OF  DYNAMIC  MODEL  FOR  SERIAL 
ROBOT  MANIPULATORS 

The  governing  equations  of  dynamics  for  serial  robot 
manipulator  systems  are  derived  based  on  motion  equations 
for  a single  rigid  body  which  were  developed  in  the  previous 
chapter.  The  mathematical  model  for  system  dynamics  is  a 
set  of  second  order  differential  equations.  These  equations 
are  highly  nonlinear  and  their  coefficient  matrices  are 
functions  of  the  joint  position  parameters  ♦.  In  order  to 
obtain  the  explicit  form  of  equations  in  deviations , one 
needs  to  derive  series  expansions  for  the  transformation 
matrix  and  the  Jacobian  matrix  with  respect  to  A*.  Then 
manipulating  the  equations  by  applying  the  vector  operations 
introduced  in  chapter  II  and  ignoring  the  high  order  terms, 
an  adequate  low  order  approximation  of  the  system  dynamic 
model  will  be  derived.  Deformation  in  links  will  not  be 
taken  into  consideration  during  model  derivation. 


Applying  Eq. (3-47) 


In  X°  ♦ X°  ® In  X°  = X + 


i».i"'’Vn.r + n'X-i°  • i.-i"'X-i°  - "'X-i 

+ "'‘V>  + <4'2> 


B of  Eq.  (4-1)  by  n lT„  and  a 


Adding  Eg. (4-2)  and  (4-4) . 


Referring  to  the  equation  above, 
equation  which  is  derived  from  t 


>ne  can  directly  write  t 
s equations  of  link  n,  1 


E ‘Tj  ( Ij  JVj°  + 


Vj0  ) 


The  terms  in  Eq. (4-6)  represent  vectors  in  a reciprocal 
6-space.  Taking  the  reciprocal  product  of  the  vector  with 
the  local  joint  axis  the  vector  equation  (4-6)  results 
in  a scalar  equation 


(4-7) 


reciprocal  product  is  invariant  under  reciprocal 


In  Eq.  (4-8),  'S,o'e,  is  a component  of  'f,  which  includes  the 
actuator  force  of  the  joint  and  the  resisting  forces 
generated  inside  the  joint.  If  we  assume  the  joints  are 
linear  springs  and  the  resisting  forces  are  linearly  related 
to  the  angular  speeds  of  the  joints,  then 

^ ® “ — K,  {♦,  - C,  *,  (4-9) 

k,  is  the  spring  constant  of  the  joint, 
c,  is  the  damping  coefficient  of  the  joint, 

♦,  denotes  actual  joint  speed  at  joint  i 

- i , is  the  deformation  of  joint  i, 
denotes  the  actual  joint  position  parameter  after 
deflection, 


I . denotes  the  desired  joint  position. 

By  substituting  ^V,°  = + 3J,°#  into  the  left  hand  side 

of  Eg. (4-8) , one  will  get 


= S J9,  o I)  V*  + E J$,  o lj  Jjj°* 


Under  the  assumption  of  rigid  links,  the  position  of  the 
mass  centers  in  the  respective  local  coordinates  are 
unchanged,  and  the  link  inertia  with  respect  to  the 
respective  local  coordinates  produces  a constant  matrix. 
However,  the  load  varies  from  case  to  case  depending  on  the 
working  conditions,  and  is  a function  of  joint  parameters 

Applying  Eq.(4-8),  (4-9),  and  (4-10)  to  every  link  of 
the  manipulator  and  rearranging  the  n equations,  one  can 
derive  a system  dynamic  model  as 

I*  + K ( * - ♦'  ) + o * = f9  + Fe  + *'  Q ♦ (4-11) 

k‘  ** 


(4-12) 


1-13) 


(4-15) 


* Q * = - 


+ n$noX°®i„  x° 


(4-16) 


Equation  (4-11)  is  not  in  the  right  form  for  solution 
because  the  coefficients  of  the  equations  are  complicated 
functions  of  ♦.  These  coefficients  need  to  be  replaced  by 


type  of  function 


fully  studied. 


such  as  a power  series  expansion  or  Fourier  series 
expansion.  Here,  a power  series  expansion  with  respect  to  a 
reference  system  is  chosen  as  the  approximating  function  for 
the  coefficients. 

Define  'reference  system'  as  the  state  of  a manipulator 
system,  for  which  all  dynamic  parameters  are  known.  Define 
'actual  system'  as  the  actual  state  of  the  manipulator 
system  at  an  instant,  for  which  all  the  dynamic  parameters 
need  to  be  found.  Let  $ , 4,  and  t denote  the  motion 
parameters  of  the  reference  system;  they  denote  reference 
position,  reference  velocity,  and  reference  acceleration, 
respectively.  Let  A# , A t,  and  A#  denote  deviations  of  the 
actual  system  from  the  reference  system.  Then 

* - * * t* 

* = * + A#  (4-17) 

* = * * A* 

i + i'ht  + A#'rA*  + 

a + fl’A#  + Lt'Q-Lt  + (4-18) 

F,  + F,'A#  + A*'F,-A#  + 

where  /,  Q,  and  Ff  are  the  corresponding  coefficients  of  the 


reference  system. 


/' , Q' , Ft ' and  Q' , F‘  are  the  derivatives  of  /,  Q, 

and  Ft  with  respect  to  joint  parameter  $ . 

Then  substituting  Eq. (4-17) , (4-18)  into  Eq. (4-11) , yields 
I A*  + C A*  + K Ad  - F + Ad'M,4*  + Ad'M^d 

+ Ad'MjAd  + Ad'M .A*  + (4-19) 

K = K + K,  +K, 

C - c + cq 

F - F,  * F,  - It  + K(d'-d)  - cd  - d'gd 

The  subscripts  for  K,,  K3,  and  Cq  indicate  the  source  of 
these  coefficients.  Equation  (4-19)  is  a high  order  non- 
linear equation.  When  Ad,  Ad,  and  Ad  are  small,  the  non- 
linear terms  are  insignificant;  Eq. (4-19)  then  reduces  to  a 
linear  dynamic  model  of  first  order  approximation  as 

Ud  + CAd  + KAd  - F (4-20) 

Since  the  linear  model  is  only  usable  in  a small  range  of 
Ad,  Ad,  and  Ad,  there  are  difficulties  for  it  as  a model  for 
systems  such  as  robot  manipulators.  Therefore,  we  use  a 
nonlinear  model  of  low  order  approximation.  The  following 
part  of  the  chapter  will  focus  on  deriving  expressions  for 


the  coefficients  of  low  order  nonlinear  terns  in  the  dynanic 

However  the  accuracy  of  the  nodel  also  depends  on  the 
accuracy  of  the  assumptions  used  for  deriving  Eq. (4-11)  and 
the  accuracy  of  the  expression  for  the  external  load  Pe. 

How  to  model  the  nonlinear  spring,  damping  and  external  load 
Fe  is  out  of  the  scope  of  this  thesis,  which  only  focuses  on 
the  nonlinearity  arising  from  geometrical,  but  not  physical. 


4.2  Perturbation  of  $,  T.  and  J 
The  joint  axis  $,  the  transformation  matrix  T and  the 
Jacobian  matrix  J are  functions  of  the  joint  position 
parameter  ♦ . Disturbances  Ad  in  the  joints,  produce 
perturbations  in  $,  T and  J.  The  perturbed  $,  T and  J can 
be  expressed  as  a series  expansion  about  S,  T and  7 of  a 
reference  system.  Then  the  expressions  will  be  truncated  to 
second  order  terms  in  Ad> 

Knowing  S of  the  reference  system  and  the  joint 
disturbances  Ad,  finding  a perturbed  $ resembles  an  initial 
value  problem,  where  S is  the  initial  vector  and  $ is  the 
final  vector.  So  before  deriving  a perturbed  $,  a quick 
review  is  given  [21]. 

(1)  If  the  differential  equations  of  a system  in  vector 


notation  are  given  by 


where  A is  a coefficient  matrix  which  can  be  a constant 
matrix  or  a function  of  t. 

When  A = constant,  X(t)  = e to*  X0. 


(2)  Let  A be  an  nxn  matrix,  then 

e*  = 1„+  A + -§-A*  + -§-A3  + ...  + — Ak  + ..(4-22) 
The  convergent  radius  of  the  series  is  ||  A H < oo . 

(3)  If  B - TAT'1  , then  eB  = e™  = T e*  T1  (4-23) 

if  AB  = BA,  then  e*'B  - e‘  eB  = eB  e*  (4-24) 

(4)  a _i  1,1,  k 1 k 

(e*)  1 = 1 - A + -j-A2  - -g— A3  + ..  +(-1)"  —A*  +..  (4-25) 

Referring  to  Eq. (3-31) , one  obtains 

9%  . . , 

9* 

Using  the  simpler  notation,  the  above  equation  becomes 


(4-26) 


or  d$  - [ Jd*  e]  $ 

Equation  (4-26)  represents  the  perturbation  of  $ under  an 
infinitesimal  input  disturbance  d0.  Integrating  d$,  the 
perturbed  $ under  the  finite  disturbance  40  can  be  obtained 

$ . e J[jd*9)$  _ e [(Jjd0)e]$  {4_27) 

(see  Appendix  6.) 

The  matrice  J in  the  equation  above  are  functions  of  4 , and 
they  can  be  expressed  by  series  expansions  about  the  initial 

J - J.  * }.  40  + .... 

And  d0  = 0 dt  = d(40) 

Hence  f Jd0  - J (/.  + J.  4*  + )d0 

- J.  4#  + 4"  40  i.  4#  + (4-28) 

(see  Appendix  7.) 

Substituting  Eq. (4-28)  into  Eq. (4-27) , yields 

$ _ e ((  JM  + 0.5  40J.40  + )®1  $ 

- { 1,  + [(  1M  + 0.5  40i„40  + ....  )®J 

+ 0.5  [(  JM  + 0.5  40J.40  + ..  )«)'  + ....  } $„ 
Truncating  the  above  equation  to  the  terms  of  second  order 
in  40  and  adding  the  original  subscripts  and  superscripts. 


the  approximate  expression  for  tl 

le  perturbed  $ can  be 

obtained  as 

% - { 16  + [(  'l‘M  + o. 

5 MtiM  )®3 

+ 0.5  [(  J'M  ) ®)! 

} % (4-29) 

where  the  detailed  expression  foi 

■ [(Afi/A#)®]  is 

[(  Mi.'M  )•]  - £ A*„ 

[(  'J.  8 j;  M )®1  (4-30) 

An  alternative  expression  of  IS1  j 

Ls  given  by 

Viu.i.  m * 

o.s  M'ilM  )«] 

+ 0.5  ((  JIM  ) 8)! 

} '*  (4-31) 

[(  Af)/A*  )8]  A*» 

((  X ® Jf  M )«]  (4-32) 

Comparing  Eg. (4-29) , (4-31)  with 

the  following  expression 

)S1  = JT,  % 

JT,  = { le  + ( ( 'JIM  + 0. 

5 MS’.M  ) ®] 

+ 0.5  ((  JIM  ) ®)? 

> X <.-»> 

JT,  = % { 16  + [(  JIM  + 

0.5  M'l'M  ) ®] 

[ ( JIM  ) «]*  } 


By  utilizing  Eg. (4-25) , 


of  JTt  can  be  obtained 


'Tj  - % { 16  - [(  V/A*  + 0.s  AfJ/A*  ) •) 

+ 0.5  [(  7/A*  ) •]*  } (4-3S) 

‘Tj  - { 16  - [(  7/A*  + 0.5  A*>J/A*  ) 8) 

+ 0.5  [(  7/A*  ) 8)*  } T,  (4-36) 

‘■’t,  - “T,  { 16  + [(7/'A*)8)  + 0.5  [ (7,"A*)8]t  +..} 
where  ( 7, “A*  )e  = A*,  ['J,e] 

For  a prismatic  joint,  ‘St  = ( 0 0 0;  s0r  ] , the  [ ‘5,8 ] matrix 
is  a nilpotant  matrix  of  order  2 that 

[(7“A*)8)2  = ( (7,"A*)e)3  = ...  =0 
'■‘T,  - "r,  ( 16  + A*,  ['1,8)  ) (4-37) 

or  = ( 16  + A*,  ("i,8]  ) "T,  (4-38) 

The  above  equations  indicate  that  a prismatic  joint  will  not 
cause  geometrical  nonlinearity. 

How  a general  Jacobian  matrix  can  be  expressed  as 


substituting  Eg. (4-29)  into 


above  equation,  yields 


- [ 0. . .0  'J,„s*/.,/A#  . .'S,e/J‘M  0...0  ] 

+ [ 0....0  'A,.,  'A,.,.... 'A,  0....0  ] 

= v‘  + '}‘  ht  * mint  (4-39) 

where  mint  is  the  notation  for  [ 0 . . 0 'A,,,  Vi,.,  . . 'A,  0 . . 0 ] 

'A.  = 0.5([(7JA#)a]!  + E A#„  [(%»V.*A#)#])«.  (4-40) 

The  accuracy  of  approximate  expressions  for  S , T and  J 
will  be  greatly  improved  if  the  second  order  terms  in  A#  are 
taken  into  consideration.  The  influences  of  the  second 
order  terms  on  the  error  of  $ will  be  examined  through  the 
following  example. 

A three  link  manipulator  as  shown  in  Fig. (4-1)  has  all 
revolute  joints,  and  its  structural  parameters  are  given  in 
Table(4-1).  The  angular  displacements  of  the  reference 
system  for  the  case  are  chosen  as  #,=0.0,  #2=1.2,  #3=-2 . 25 
(radians) . The  actual  system  is  disturbed  from  the 
reference  system  by  a joint  deviation  A#=[0.05  0.05  0.02)'. 
Then  the  linear  approximation  of  the  perturbed  °$,  under  A# 


can  be  calculated  from 


(°$„>i  = ( 16  + C(  V,'A#  )®J  ) "t. 

The  quadratic  approximation  of  perturbed  °S,  under  A#  can  be 
calculated  from 


<°?.>2  “ { h * + 0.5[{V.*A#)*)! 

+ 0.5A#,  [(%®V,'A#)®]  + 0 . 5A$2  [(%®y,’A0)®] 

+ 0.5A*j  [CJ,®V.’A*)®)  > -J, 

The  difference  of  (°$e)[  from  the  accurate  °$c,  denoted  by 
D$,,  will  be  obtained  from 


Then,  the  error  component  of  (D9e),  in  direction  is 
calculated  from 


The  error  component  of  (°$e) ; in  position  is  calculated  from 


calculate 


the  following  expressions 


As  Ad  is  increased  by  multiplying  by  a scalar  A,  both 
errors  of  (°$c),  and  errors  of  (°$e)j  will  increase.  (°$e) , 
and  ( a$e) 2 with  respect  to  X = 1,2,..  10  are  listed  in 
Table (4-2),  which  indicates  that  the  quadratic  approximation 
is  much  more  accurate  than  the  linear  approximation.  Figure 
(4-2)  shows  the  relations  between  errors  and  A.  In  the  log- 
log  plot,  they  are  straight  lines  of  different  slopes.  As  1 
increases,  the  two  lines  er,  and  er2  in  Fig. (4-2,  a),  and 
the  two  lines  erol  and  ero2  in  Fig.  (4-2,  b)  approach  one 
another.  This  indicates  that  the  higher  order  terms  will 
take  more  important  roles  in  the  approximation  as  Ad 

The  ratio  of  Ad[/Ad2/Ad3  also  affects  the  errors.  This 
will  be  demonstrated  by  again  using  the  reference  position 

Figures  (4-3)  and  (4-4)  record  the  errors  of  °SC  when  Ad2/Ad3 
changes.  The  distance  from  the  point  in  a closed  curve  to 
the  origin  of  the  planar  coordinates  (X,-X2)  indicates  the 
magnitude  of  error.  The  ratio  of  the  coordinates  of  the 


point,  Xj /X2,  equals  the  ratio  of  A<l>-/A<i- . For  the 
manipulator  as  shown  in  Fig. (4-1),  the  ratio  of  A0,/A4,  does 
not  effect  ert  and  er?,  hence  the  curves  er.  and  er?  are 
circles  about  the  origins.  Changing  the  value  of  A41(  the 
corresponding  error  curves  can  be  obtained,  which  are 
plotted  in  Fig. (4-5)  and  Fig. (4-6) . Based  on  numerical 
results,  one  concludes  that  in  order  to  maintain  the  overall 
error  less  than  5%,  every  A4,  in  A4  must  be  less  than 
4* (Intel. 3)  when  the  linear  approximation  of  the  perturbed 
°$e  is  used,  or  less  than  8.5‘ (lnX=2.0)  when  the  quadratic 
approximation  of  the  perturbed  is  used. 

4.3  Derivations  of  Coefficient?  for  Nonlinear  Terms 

I,  Q,  and  F in  the  system  governing  equation  (4-11) 
are  functions  of  ♦.  The  deviation  from  the  reference 
position  causes  perturbations  in  I,  Q,  and  Fg,  and  therefore 
produces  nonlinear  terms  in  the  equation.  In  this  section, 
we  will  derive  the  perturbed  Z,  Q,  F . , and  then  the 
corresponding  coefficients  of  the  nonlinear  terms  caused  by 
their  perturbations. 

The  joint  velocities  and  accelerations  of  the  gross 
motion  of  manipulators  can  be  chosen  as  t and  4 for  the 
reference  system.  Since  the  magnitues  of  joint  velocity  and 
acceleration  of  the  gross  motion  are  usually  the  same  as 
those  of  the  deviated  motion,  one  can  set  4-°  and  4=0  in 


order  to  simplify  the  process  of  equation  derivation. 

Referring  to  Eq. (4-15)  and  substituting  #=0,  the 
inertia  matrix  for  the  actual  system  is  obtained: 


A* 

A* 


Substituting  Eq. (4-29)  and  (4-39)  into  the  above  equation, 
J»,  o Ij  V4* 

= { 16  + [(!/,'A*+0.5Aff,'A*)e]  + O.S((i//A*)®]?+..}  'I, 
o Ij  ( <]•  + + . . ) A* 

= 'j,  o ij  j;  ti 

+ ('JiMia’S,  O Ij  'y;  a# 

+ '«  © ij  ( ) a*  + ..  (4-4i) 

where  Ij  is  the  inertia  matrix  of  link  j about  its  own  local 
coordinates,  and  is  not  effected  by  A#.  Applying  Eq. (2-29) 
or  (2-30),  the  triple  vector  operations,  one  can  derive 

( '/(A#)  ®'J,o  Ij  ‘j;  Li 


(ij 


- - Ad'  ( ‘if 


% o ij  (‘ifii  t* 

= 'i,  o ij  [ '$M  'SM '$,M  o 


% © Ij  % 


A*'  H„  4* 
id'  M„  A# 

. A*'  M3„  A* 


(4-43) 


40'  Hj  A# 


1-46) 


: t‘j;ra  ij  •]>,)  - 


Since  i is  chosen  to  be  zero,  the  elements  of  4'Q4  can 
be  written  as 


J$,  © I,  Jjj°  A*  + o ( S3S°  Li  )®  Ij  >3°  A* 


J$,  O I,  >3°  Li 


J9,  O Ij  ( S3,°  A*  ) Li 


- Li' 


Li 


(4-48) 


’S,  o ( ‘3°  Li  ) e Ij  *3°  Li 


= - ( JJj°  Li  ) o j$,  ® Is  1 J ° Li 


= - Li ' 


Ij  %/  ) Li  (4-49) 


40'  Q 4# 


4dT  Q,  40 
A*'  Q2  40 

40'  Q„  40 


(4-50) 


Q in  the  above  equation  is  the  coefficient  with  respect  to 
the  actual  position.  It  is  the  sum  of  the  corresponding 
matrix  for  the  reference  system,  M,  , and  its  deviation  from 
the  reference  system,  AM,.  m4,  and  AM,  are  derived  by  using 
the  same  techniques  as  those  for  deriving  M3, 

S % 0 Ij  •$, 


M„  = 'J; ) - 2 'S,  o Ij  % 


(4-53) 


■III4#  q,?A#  qlnA* 

■1114#  1114#  • • ■ ■ ‘fen4# 

3nl4*  Irt4*  q™4# 


3Ij  ['*.•]«.  - 'Jplj['J.e)'J,  + ) 


- £ ( - (S,o[XJ'i,8)'j,  - 'S.ot'S.ajlj'S,  ) 

(4-54) 


For  F_,  we  ignore  the  tedious  equation  manipulation  and 
just  list  the  derived  expressions. 


F,  = F,  + K,  A*  + A#'  M,  A#  (4-55) 

f E 'S,0'F, 


(4-56) 


S,0 


E 'F,  O ('5,8]  i/,'  +'5 


K,  - E^'F.O  [%•]  '7/ + '5,8  ('F.8]  ’7.' 


(4-S7) 


0 + 1.  O fF,«J  -/.* 


40'M,40 


(4-58) 


Ml(  - z{  '7,"o['S,e]  ['F,8]  VJ  + 0.5  '7,"o(’F,8]  ['i,8]  Ijj 
+ 0.5  VJ'o  ['5,8]  ['F,e]  V‘  } 


E “5,  0 [(  V'5, 
+ 0.5  ^E  '5,  0 [(  r„"5, 
°S.,  0 [ ( V "5,  a 


® 'F,  )0)  *7/ 
8 'F,  )8)  "7/ 
•F„  )8]  V" 


’$„  o [ •$,  0 Y„  ] 0 V.* 


7*0  is  the  transformation  matrix  which  transfers 
the  gravity  force  of  link  j at  the  mass  center  to 
the  origin  of  the  j-th  coordinate  system. 

Once  the  coefficients  have  been  calculated,  the 
construction  of  system  dynamic  model  is  completed.  The  next 
step  is  solving  the  governing  equation,  which  is  the  main 
topic  of  the  following  chapter. 


Table  (< 


Ln  er 


Ln  er 


Fig. (4-3)  Error  of  $e  from  linear  approximation 
and  the  ratio  of  W2/4#j  (44,-0.15) 


Fig. (4-4)  Error 


quadratic  approximation 
f A02/A#3  (A4,=o.15) 


Error  of  $e  from  linear  approximation 
and  the  ratio  of  4tf,:A#z:A#3 


Fig. (4-5) 


Fig. (4-6)  Error  of  $„  from  quadratic  approximation 
and  the  ratio  of  4#,:A0Z:4#3 


CHAPTER 


method  of  multiple  scales. 


Poincare  method,  and  the 
important  common  feature  among  the  perturbation  methods  is 
the  scaling  factor  c,  a dimensionless  indicator  of 
magnitude,  which  measures  the  influence  of  every  term  on  the 
system  dynamics.  In  this  chapter,  there  will  be  discussions 
about  applications  of  the  scaling  techniques  in  forward 
dynamic  analysis,  inverse  dynamic  analysis,  and  reverse 
position  analysis  for  serial  robot  manipulator  systems. 

5.1  A Review  of  the  Perturbation  Method 
A system  with  one  degree  of  freedom  has  the  nonlinear 
governing  equation 

u + f(u)  - 0 (5-1) 

f (u)  is  a nonlinear  function  and  can  be  expanded  by  an 
infinite  power  series  in  u 

f(u)  - f0  + a,u  + a2u*  + ....  + a„u"  + R„(u)  (5-2) 

Since  u=0  is  set  to  be  the  equilibrium  point,  then  fo=0 . 

The  series  is  convergent,  hence  the  series  can  be  truncated 
according  to  the  accuracy  required  for  the  final  results. 
Substituting  f(u)  into  Eq. (5-1)  after  truncation,  yields 


The  error  in  the  solution  of  Eq. (5-3)  caused  by  the 
truncation  will  be  of  the  order  of  u"*1,  which  is  denoted  as 


solution  of  Eq. (5-3) 


also  be  expressed  by 


u = e u,  + e'u;  + e^j  + + «X  + (5-4) 

£ in  the  equation  above  is  a small  dimensionless  factor 
( £«1  ) . £ indicates  the  magnitude  of  a quantity.  The 

magnitude  of  the  term  of  u,  in  Eq.  (5-4)  is  in  the  order  of 
f1  and  the  magnitude  of  the  term  of  u„  is  in  the  order  of  fn. 
Hence  £ is  referred  as  the  scaling  factor.  Substituting 
Eq. (5-4)  into  Eq. (5-3)  and  setting  the  coefficient  of  each 
power  of  f equal  to  zero  yields  the  following  set  of 
equations: 

£'  u,  + a,U|  = 0 (5-5) 

«*  Oj  + a,Uj  = - a2u,*  (5-6) 

£3  a3  + a,u3  = - 2ajU,Uj  - a3u,3  (5-7) 

Equation  (5-5)  is  a homogeneous  linear  equation;  its 
solution  u,  depends  upon  initial  conditions.  When  the 
system  has  an  external  load  f,(t),  Eq.  (5-5)  will  be 

Q,  + alU|  = fe(t)  (5-8) 

Equation  (5-6)  is  a nonhomogeneous  linear  equation.  The 
solution  u2  is  calculated  from  u,,  but  u2  will  not  effect  u,. 
Equation  (5-6)  is  referred  to  as  a sub-level  equation  in  the 


To  obtain  an  accurate  solution  of  a nonlinear  equation, 

equations.  This  is  not  only  impossible  but  also 

which  is  equivalent  to  0(£"*‘),  and  u„,1(  un.2,  — are  the 

beyond  the  n-th  sub-level  and  only  solve  the  first  n linear 
equations  step  by  step  to  get  the  results.  Hence  the 
perturbation  method  actually  decomposes  a nonlinear  equation 
into  a finite  number  of  linear  equations.  The  decomposition 
provides  the  opportunity  for  one  to  use  techniques  and 
knowledge  existing  for  linear  systems. 

5.Z  Forward  Dynamic  Analysis 
Forward  dynamic  analysis  is  an  initial  value  problem. 
The  numerical  results  are  usually  obtained  from  simulations. 
The  primary  task  of  forward  dynamic  analysis  is  to  calculate 

perturbation  method,  only  the  coefficients  of  the  reference 


m of  the 


iighborhood 


simulation  technique  cooperating  with  the  perturbation 
method  will  be  presented. 

At  the  instant  t0,  the  system  motion  equation  is 

I + C A#„  + K A#„  = F + A*,1  H,  A*„  + A#0T  H;  A#0 
+ A Ha  A*„  + A^0'  (H4+AM4)  A*„ 

where  A^0,  A0.. , and  F are  Known  parameters.  Since  the  above 
equation  is  derived  with  respect  to  the  system  equilibrium 
then 

F = 1 *,  (*'-*)  - (*'-*)'  M,  <♦'-#) 

Let  A#0  = £A#,+«2A^j  , then  F can  be  written  as 

F = < ir.  + k,  (*’-*)]  - £ZI  (*'-#)'  H,  (♦'-#)] 

- t F|  + t*  Fz 

Substituting  A and  F into  the  above  equation  yields 
I (£A^+£ZA^)  + C fA*0  + K £A*„  = £ F,  + t!  F2 

+ £2  A0O'  H,  A#0  + £2  A*0'  Hj  A#0 
+ <£A#l+e2A#3)T  H3  £A*0  + £2  A#0'  ((VAN.)  A#0 
From  this  expression,  one  can  derive  two  levels  of  equations 
e1  I A<,  + C A#0  + K A#0  = F,  (5-9) 

£2  I A#,  = F2  + A#c’  H,  A*„  + A#,'  H,  A t0 

+ A#0'  Mj  A*0  + A#„'  (M4+AM4)  A#0 


(5-10) 


Based  on  Eg. (5-9)  and  (5-10) , the  detailed  simulation  steps 
are  given  as  follows: 

(1)  Choose  the  reference  position,  and  calculate  the 
coefficients,  I,  C,  K,  and  extra  coefficients,  M,,  AM4  from 
Eg. (4-45)  - (4-60) , 

(2)  Assign  the  initial  conditions  to  the  variables;  hia  to 
the  joint  position,  and  A#0  to  the  joint  velocity, 

(3)  Calculate  the  first  approximation  of  the  joint 
acceleration 

A#!  - I*1  ( Fj  - C A#0  - K A$0  ) 

(4)  Calculate  the  second  order  terms  of  the  joint 
acceleration 

A#?  = I'1  [ F,  + A#0r  M,  A#„ 

+ Af,'  H;  A*0  + A#,'  M3  A*„  + A#0'  (M4+AM4)  A*„  ) 

(5)  Then  A*„  = A + A*?, 

A#,  = Af,  At  + A*0 
A*,  = A#0  At  + Af, 

(6)  A#0  = A#. , A*0  = A#,,  and  iterate  from  step  3 to  step  6. 
Because  b+z  has  been  calculated  from  the  second  level 
eguation  in  the  process,  the  accuracy  of  the  results  which 
includes  will  be  higher  than  those  from  the  linear 
eguations.  This  advantage  of  using  the  perturbation  method 
will  be  examined  through  the  following  example. 

The  sample  manipulator  for  the  example  is  the  same  one 


as  shown  in  Fig. (4-1) . The  related  known  parameters  are 
listed  in  Table(5-1)  and  (5-2) . The  end-effector  moves  from 
the  initial  position  to  the  final  position  under  a step 
input  of  the  position  command.  The  joint  angles  for  the 
final  position  are  *’=[0.0  1.0472  -2.0944]'.  The  joint 
angles  for  the  reference  position  are  *=[0.0  1.2  -2.25]'. 

The  step  inputs  in  the  joints  are  <*=[0.3  0.1  0.2]'. 

Further,  C=0,  *=0  and  *=0.  After  calculating  the 
coefficients  for  the  reference  position,  the  solution  of  the 
nonlinear  model  can  be  obtained  by  applying  steps  (1)  to 
(6).  The  numerical  results  from  the  original  equation 
(4-11)  and  its  linear  approximation  are  also  calculated. 

The  systems  responses  in  position  from  the  three  types  of 
dynamic  models  are  plotted  in  the  same  diagrams  in  Fig. (5-1) 
to  Fig. (5-9)  for  the  purpose  of  comparison.  Curves  denoted 
as  curve  1 in  the  figures  are  the  curves  of  the  linear 
model.  Curves  denoted  as  curve  2 are  the  curves  for  the  low 
order  nonlinear  model.  Curves  denoted  as  curve  3 are  those 
of  the  original  equations.  The  following  observations  can 

(1)  Curve  2 in  Fig. (5-1)  to  (5-3)  is  plotted  from  the 
numerical  results  of  a revised  version  of  the  nonlinear 

I A*0  + C A*0  + K A*0  = F,  + A*0'  M,  A*0  (5-11) 

Thus,  curve  2 represents  the  system  response  at  the 


reference  position.  It  is  noted  that  curve  2 and  curve  1 in 
the  three  figures  are  almost  the  same.  This  indicates  when 
the  reference  position  is  chosen  near  the  final  position, 
the  linear  model  is  quite  accurate. 

(2)  Curve  2 in  Fig. (5-4)  to  Fig. (5-6)  is  plotted  from  the 
numerical  results  of  the  nonlinear  equations 

I A#0  + C A*0  + K = F,  + Af,’  Hj  A#„ 

+ A*0'  H,  A#0  (5-12) 

It  is  noted  that  curve  2 in  Fig. (5-4)  moves  towards  curve  3 
from  its  position  in  Fig. (5-1) . The  same  phenomenon  is 
observed  for  curve  2 in  Fig. (5-5)  and  (5-6) . Thus,  the  term 
A*0tM3A#0  measures  the  change  in  frequency  from  the  reference 
position  to  the  final  position. 

(3)  Curve  2 in  Fig. (5-7)  to  (5-9)  is  plotted  from  the 
numerical  results  of  the  nonlinear  equations 

I A*„  + C A#„  + K A*0  = F,  + A#„'  H3  A*„ 

+ A#0'  (H4+AM4)  A(l0  (5-13) 

Curve  2 nearly  coincides  with  curve  3.  This  means 

-#)'M,(4  -t)  is  small  in  magnitude.  This  fact  also 
exists  in  the  general  case.  Hence  the  quadratic  terms  of  H, 
can  be  ignored.  AM4  represents  the  change  of  M4  with 

small  compared  to  M4.  When 


respect  to  A0.  Usually  AM4  is 


the  system  is  in  the  neighborhood  of  a singularity,  the 
influence  on  A^  from  the  centripetal  and  Coriolis  inertia 
force  ( A#'(H4+AM,)A#  ) is  insignificant;  which  means  AM,  is 
insignificant  since  then  M,  approaches  zero.  Therefore,  AM, 
can  also  be  ignored. 

From  the  arguments  above,  one  can  conclude  that 
A#C  M,A#0  and  A0o'M,A#o  are  the  most  significant  nonlinear 
terms.  Therefore,  Eg. (5-12)  is  suggested  as  the  dynamic 
model  for  manipulator  systems. 

5.3  inverse. pynamic  Analysis 

Given  the  initial  condition  and  the  final  condition  of 
the  system,  the  joint  acceleration  can  be  determined  based 
on  the  restrictions  which  have  to  be  satisfied,  such  as 
maximum  joint  forces  or  torques,  or  minimum  time  for  task 
execution.  The  main  application  of  inverse  dynamics  is  in 
system  control. 

Based  on  the  argument  in  the  previous  section,  one  can 
use  quadratic  nonlinear  equations  (Eq. (5-12))  as  the  system 
model  for  inverse  dynamic  analysis 

I A#  + C hi  + K ht  = F + A^'  M3  Li  + A#'  M,  A#5-14) 
Here,  the  initial  joint  parameters  A0O,  A#0,  and  A t are 
known.  A^  is  calculated  from  the  quadratic  equations.  Then 


the  joint  forces  or  torques  can  be  found  since  they  are 
functions  of  A#.  Let 

A#  = £A*,  + £*A*2  (5-15) 

Substituting  Eq. (5-15)  into  Eq. (5-14)  yields 

I (£A#„)  + C (£A#0)  + K (fA#,+£2A*2) 

= fF  + (£A*0)'  Mj  (£A4,+f2A02) 

+ £*  Af,'  M4  A#0  (5-16) 

where  £ attached  to  A#0,  A^0,  and  F indicates  the  magnitudes 
of  these  three  variables  are  of  the  order  of  £.  From 
Eq.(5-16),  the  first  two  sub-level  equations  can  be  derived 

£ I A#0  + C A^0  + K A^j  = F 

£*  K A#2  = A*0'  Hj  A*,  + Af,'  H,  A#0 

The  above  two  equations  result  in 

A#i  = K'1  (F  - I AJ,  - C A#„)  (5-17) 

A#2  = K'1  (Af,1  M3  A#,  + A#0'  H,  A#0)  (5-18) 

A#,  is  the  solution  of  the  reference  position  for  a system 
of  low  kinetic  energy.  A#2  indicates  the  compensation 
needed  if  the  system  is  in  the  neighborhood  of  the  reference 
position  but  not  at  the  position  itself  and  has  higher  level 


>f  kir 


antrollabil ity 


will  be  extended  when  is  also  included  in  the  algorithm. 
By  examining  the  expressions  for  M3  and  M4,  Eq. (4-47) 

when  M4  needs  to  be  calculated. 

Kinematic  Happing  and  the  Inverse  of  Jacobian  Hatrix 

In  both  forward  and  reverse  dynamic  analysis,  the 
initial  position  and  velocity  of  every  joint  must  be  known. 
The  position  and  velocity  of  the  end-effector  in  Cartesian 
coordinates  are  usually  given.  To  find  joint  parameters 
from  the  parameters  of  the  end-effector  in  Cartesian 
coordinates  is  referred  to  as  'mapping  from  Cartesian  space 
to  joint  space. ' One  of  the  examples  is  the  mapping  between 
velocity  of  the  end-effector  and  the  velocity  of  joints. 

The  expression  for  this  mapping  is  given  by 


(5-19) 


are  usable  in  this  case,  and  whether  the  mapping  remains 
invariant  with  respect  to  a change  of  coordinate  systems 
and/or  a change  of  units  of  the  vectors.  These  problems 
will  be  examined  in  the  following  part. 

Based  on  the  existing  formula,  the  left  pseudo-inverse 
of  J,  denoted  as  J* , is  given  by  J*  = (JTJ) "lJT . This 
expression  is  not  usable  because  the  mapping  varies  as  the 
coordinate  system  changes.  The  problem  arises  from  the  same 
reason  as  that  for  the  'orthogonal  complement' [2€]  because 
the  inner  product  of  matrices  j'j  is  involved,  and  it  can  be 
overcome  by  using  the  reciprocal  product  instead  of  the 
inner  product. 

When  n<6,  there  are  more  equations  than  unknowns  in 
Eq. (5-19).  One  can  derive  a solution  which  satisfies  only  n 
equations.  The  n equations  are  selected  by  taking  the 
reciprocal  product  of  V with  n bases  of  the  reciprocal  space 


The  above  equations  can  be  expressed  as 


(A'oJ)  * 


where  A is  an  auxiliary  matrix  in  dimension  of  6xn, 
a'oJ  is  a square  matrix  of  dimension  of  nxn. 

Taking  the  regular  inverse  of  a'oJ,  yields 

♦ = (A'oJ)-1  AtO  V (5-20) 

The  auxiliary  matrix  A has  to  be  of  rank  n in  order  to  keep 
(A'oJ)  nonsingular  (see  Appendix  8) . The  column  vectors  in 
A can  be  any  n independent  vectors  in  the  space.  J itself 
can  also  be  the  auxiliary  matrix , then 

♦ = (JTOJ)‘‘  j'o  V (5-21) 

The  proof  of  invariance  of  Eg. (5-20)  with  respect  to  a the 
change  of  coordinate  system  and/or  a change  of  units  of  V 

Proof  of  the  invariance  under  coordinate  transformation: 
After  multiplying  by  a transformation  matrix,  one  obtains 

TV  = TJ  ♦ 

and  the  auxiliary  matrix  as  TA.  Applying  Eq. (5-20),  yields 

♦ = ( (TA)'o(TJ)  J'1  (TA)ro  TV 

= [A1  (T'oT)  J]'1  A1  (T'oT)  V see  Appendix  9. 

= (A1  [1]  J)'1  A (X)  V (Tr0T)  - [1] 

= (A'oj)~‘  a'o  V [1]  is  equivalent  to  o 

End  of  proof. 


Proof  of  the  invariance  under  change  of  units: 

Let  0 be  a diagonal  matrix  which  represents  the  change  in 
units  of  V.  Let  r be  a diagonal  matrix  which  represents  the 
change  in  units  of  4.  In  the  new  unit  system,  Eq. (5-19) 
will  be  in  the  form  of 

0 V = 0 J * = (0jr‘)  » 

Let  V*  = 0 V,  4'  = T4,  and  J*  « 0JI"1 , then  the  above  equation 
can  be  written  as 

V*  = J'  *' 

Since  the  column  vectors  in  the  auxiliary  matrix  are  vectors 
in  the  Cartesian  space,  matrix  A in  the  new  unit  system  will 

A*  = OAT1 

Applying  Eq. (20) , yields 

4'  = (a"gjV  a"o  V* 
r*  = (a'W)  _1  a"o  ov 
♦ = ( r1  (a'W)  ■■  A'To  0 I V 

Now  one  needs  to  prove  that  r1(A,,oJ,)'lA,,o0  = (a'oJ) “'a'o. 
rl  (A'W)-1  A,ro  0 
- T‘  (A'W)’1  a'to  0 

J'1  (0AT1)1  o 0 


r1  ( (OAr1)1  o 0jr‘ 


r1  { try  (a'b'obj)  r1 


= (aWoBJ)"1  A1  8to0 


Because  ' 


f linear  and  angular  velocities, 
the  form  of 


L 03  a2[l]3J 

the  ratio  of  angular  velocity  after  the  change 
f units  vs.  those  before  the  change  of  units, 
:he  ratio  of  linear  velocity  after  the  change 
f units  vs.  those  before  the  change  of  units, 


[ Mlh 


Mils 


a2[lJ3  J 

a,a?[l]3 


- a,a,  [1,J 

(aVo&J)  1 A'e'oB  = ( a,a?  a'[16]J  )'*  a,a3  a'[16] 


The  general  form  of  the  pseudo-inverse  ir 


is  therefore  given  by 


obtained  by  minimizing 


F = *'b*  + 2Xt  (V  - ji)  (5-23) 

By  setting 

3F 

a*, 

BF 

=0,  j - 1,  2 n 

8X1 

one  finds 

Substituting  the  above  equation  into  V = J*,  yields 


X = (JBJ1)1  V (5-25) 

Substituting  Eq. (5-25)  into  Eq. (5-24) , yields 

t = BJ1  (JBJ1)'1  V (5-26) 

Proof  of  the  invariance  under  coordinate  transformation: 

The  equation  after  the  change  of  coordinate  system  is 
given  by  TV  = (TJ)  ♦.  The  weight  matrix  B will  not  be 
affected  by  the  coordinate  system.  Then 


[TJ  B (TJ)' 


E the  invariance  under  a change  of  units: 
s equation  after  the  change  of  units  is  given  by 


If  the  weight  matrix  i 
expression 


(wr1)  r* 

new  unit  system,  B , satisfies 


Then  the  solution  of  * from  Eq. (5-26)  is  invariant  und 
change  of  units 

Let  V*  = 0 V,  = r* , and  = tor1.  Then  the  above 
equations  can  be  written  as 


= r'B*  (tor1)1  ( tor1  b'  (tor1)1  ] ' e v 
= r'B'fr1)'  jt  e'  [ to  rWfrV  j'  e'  ]■*  e v 
= B J1  e'fB')1  (JBJ1)'1  0''8  v 
- B J1  (JBJ1)  1 v 


the  right 


a of  J which  minimizes  *'b*, 


where  B is  a weight  matrix  of  optimization  and  B*  = T B I4. 
Height  matrix  B represents  the  criterion  of  the  system 
optimization;  hence  a different  B results  in  a different  J*. 


5.5  Approximate  Happing  of  Deviations 

Knowing  the  deviations  in  position  and  velocity  of  the 
actual  system  from  a reference  system  in  Cartesian 
coordinates,  to  find  the  corresponding  joint  deviations  is 
the  mapping  of  deviation  from  Cartesian  space  to  joint 
space.  The  mapping  is  nonlinear  and  can  also  be 
approximated  by  linear  mapping  or  low  order  nonlinear 
mapping.  In  this  section,  the  mapping  technique  of 
quadratic  approximation  will  be  studied. 

Let  $0,  $0,  J0  and  jo  be  the  coefficient  matrices  for  a 

the  actual  system  in  Cartesian  space.  Let  A*  and  A*  denote 

velocity  at  the  reference  position  to  be  zero,  v„  = 0,  and 
* = 0.  Then  the  quadratic  approximations  of  A$  and  AV  can 


5-29) 


A$  = S - $„  = S„  A*  + A#S„A*  (5 

AV  - V - V0  = ( J0  + j0  AS  ) AS  (5 

where  ASS0AS  = X/2(  ((J0AS)®]2  + A#'  j„  A S ) $0 
Let  AS  = £ A#,  + £2  A*, 

A#  = f A#,  + £2  AS; 

Substituting  A#  and  AS  into  Eg. (5-26)  and  (5-27) , yields 
A$  = S0  (eAS,+£2AS;)  + (£AS,+f2AS;)  8.  (£AS,+£2AS;) 

AV  = ( J0  + (eAS,+f2AS,)  ] (fAS,+£2AS;) 

One  can  derive  two  sub-levels  of  equations 
£:  AS  =.  $0  A#, 

£2:  0 = $„  AS;  + AfS0A#, 

0 = J0  A#,  + AS,j0AS, 


Afi  = So'1  AS  (5-30) 

A#i  = J0'1  AV  (5-31) 

AS;  = - S,'1  ( AS.S.AS,  ) (5-32) 

AS;  = - J.'1  ( AS,J0AS,  ) (5-33) 


where  $0‘*  is  derived  by  applying  the  same  technique 


for  finding  J0‘‘.  Utilizing  Eq. (5-31)-(5-34)  in  the  forward 
(or  inverse)  dynamic  analysis,  the  unknown  A0  (or  A$)  can  be 


directly  calculated  from  A$  and  Av. 


5j-S_Reverse  Displacement  Analysis 
Reverse  displacement  analysis  is  one  of  the  major 
issues  in  robotics.  Knowing  the  position  of  the  end- 

solve  a set  of  algebraic  and  transcendental  equations  which 
are  obtained  from  the  forward  displacement  analysis. 
Numerical  iteration  methods  are  based  on  a first  order 
derivative.  In  order  to  increase  the  convergence  rate  of 
the  iteration,  the  second  order  derivatives  are  included ; 
then  a nonlinear  model  is  obtained.  In  this  section,  the 
second  order  model  and  the  application  of  the  perturbation 

The  advantage  of  using  the  nonlinear  iteration  will  be 
demonstrated  through  an  illustrative  example. 

Let  $ be  the  axis  of  the  end-effector  and  t be  the 
accurate  solution  of  displacement  analysis.  Let  $0  be  the 
position  of  the  axis  corresponding  to  the  previously 
approximated  *0.  Referring  to  Eq. (4-29) , one  can  write 


= 


A*$0A*  + .... 


* - #0 


*0  “ - [So®]  Jo 

A*$„A*  - 1/2 ( [(J0A#)e]*  + A#i„A#  ) $0 
let  ht  = eAf,  + £JA#Z  + . . . . 

Substituting  Li  into  Eg. (5-19)  and  equating  coefficients  of 
like  powers  of  t yields 

e:  D$  = $„A*,  (5-35) 

0 = 9„A#2  + Lil$0Lil  (5-36) 

Hence,  A*,  = DS 

A*,  = * So''  < ) 

Then  the  new  approximation  of  i will  be 
i = f,  + A*,  + A*, 

The  influence  of  Li2  on  the  convergence  rate  of  the 
iteration  will  be  examined  through  the  following  example: 

The  joint  angles,  ♦,  of  a 3-R  manipulator  as  shown  in 
Fig. (4-1)  are  i - [0.1  -0.1  0.2]r.  The  position  of  the  end- 
effector  in  global  coordinates  x0y0s0  can  be  calculated  from 
♦.  The  auxiliary  matrix  for  finding  S0*  is  chosen  as 


litial  gut 


When  A*, 


ess  of  t is  [0.4  -0.4  0.8]'. 
included  in  the  algorithm,  after  3 iterations,  the  absolute 
errors  of  the  approximation  of  t are  0.0001  (radian)  in 
orientation  and  0.0001  (inch)  in  position  of  the  end- 
effector.  But  when  is  not  included  in  the  algorithm,  5 
iterations  must  be  carried  out  before  reaching  the  same 
accuracies.  The  data  of  the  two  cases  are  listed  in  Table 

The  use  of  the  nonlinear  model  reduces  the  number  of 
iterations,  while  the  number  of  computations  in  each 

The  benefit  of  reduced  computing  time  from  the  improvement 
in  the  accuracy  of  system  modeling  surpasses  the  detrimental 
gain  in  time  from  the  complication  of  the  nonlinear  model. 

It  should  be  emphasized  that  the  perturbation  method  is 
based  on  the  linear  method;  thus,  the  current  method  is  not 
particularly  beneficial  in  the  neighborhood  of  a 
singularity. 


(5-1) 


all  zeros 


- (5-1)  System  response  of  step  input  in  joint  1 
from  the  model  of  Eq. (5-11) . 


Fig. (5-6)  System  response  of  step  input  in  joint 
from  the  model  of  Eg. (5-12) . 


Fig. (5-7)  System  response  of  step  input  in  joint 
from  the  model  of  Eg. (5-13). 


Fig. (5-8)  System  response  of  step  input  in  joint  2 
from  the  model  of  Eq. (5-13). 


le  (5-3) 


CHAPTER 


CONCLUSIONS  AND  FUTURE  WORK 

The  main  objective  of  this  work  is  to  study  the  effects 
of  geometrical  nonlinearity  on  serial  robot  manipulators. 

Two  major  problems  have  been  addressed: 

system  model  and  the  method  for  finding  the  solutions, 
(2)  the  applications  of  the  new  technique  on  robot  system 
analysis,  including  forward  dynamic  analysis,  inverse 
dynamic  analysis,  and  reverse  displacement  analysis. 

The  derivation  of  nonlinear  models  is  far  more 
complicated  than  that  for  linear  models.  The  notation  used 
to  represent  the  system  motion  parameters  is  the  key  factor 
for  simplifying  the  process.  It  has  been  demonstrated  that 
the  Plucker  coordinate  representation  considerably  simplify 


undergoing  large  gross  motion.  In  order  to  simplify  the 
dynamic  model,  a quadratic  nonlinear  model  is  derived  by 
keeping  only  these  two  major  nonlinear  effects.  The 
applicability  of  this  model  has  been  examined  through 
forward  dynamic  analysis. 

One  of  the  ultimate  goals  of  studying  the  dynamic  no 


The  kinematic  mapping  from  Cartesian  space  to  joint 
space  has  been  studied.  The  inverse  Jacobian  matrix  whic 
keeps  the  mapping  invariant  under  a change  of  coordinate 
system  and  a change  of  units  has  been  developed. 

This  work  has  concentrated  on  developing  a technique 
for  nonlinear  system  analysis  of  serial  robot  manipulator 
Many  detailed  studies  need  to  be  carried  out  such  as:  (1) 
survey  the  change  of  the  system  inertia  with  respect  to 
joint  deviations  in  the  entire  workspace;  (2)  to  optimize 
computing  code  for  speed  of  execution;  (3)  to  adjust 
criteria  for  better  structural  design;  (4)  to  enhance  the 
existing  controllers  by  nonlinear  compensation.  These  are 
tasks  for  future  work. 


APPENDIX 


Proof  of  Eg. (2-20) 


R-03+03.R  R-R'-Oj-R'iax] 

(dxJR-Oj+R-R1  (dXJR-R'-R.R'jdx] 
R1  * [ dx ] R-R1  ( dx ] • R R'-R-R'(dX)  -03 
0j-[dx]R+R'.R  Oj-R+R'-Oj 


Proof  of  anti-commutative  law  of  the  vector  cross  product 


[SjX]  o3 
[S20x]  [S2X] 


(2-13)) 


3.  Proof  of  Eq. (2-28) 


$,  © $2  8 $3  = s,  ® S2  o $3 


[S2x]  o3 
ts20x)  [82x] 


Proof  of  Eq. (2-29) 


S,  a ($2  8 $3)  = ($3  ® $,)  8 $2  - (S2  8 $,)  ® $3 


),  0 ($2  8 $3) 


[SjX]  o3 
C ®2ox  3 (Sjx) 


S10X(S2XS3)  + 8,  X (8,5X83)  + BjXfSjXSj,,) 

(S3  8 $,)  8 $,  = - 8 (?j  8 $,) 

S2  X (83  X 8,) 

S?0X(S3XS,)  + S,x  (833X8,)  + SjX  (83X8,0) 
(83  X 8,)  X 83 

(SjXS,)xS20  + (833X8,1x8,  + (S3xSI0)  xS, 

(S,  8 s,)  0 S3 

(s2  x 8,)  X S3 

(S2XS1)XS30  + (SjjXS^xSj  + (83X8,5)  XS3 

From  Eg. (2-16),  one  have 


8,  X (S20  X S3)  = (S3  X 8,)  X S20  - (S20  X 8,)  X S3 
8,  X <s2  X 835)  = (S35  X 8,)  X 8,  - (8,  X 8,)  X 833 


invariance  of  operations  related  to  reciprocal 


product 

(1)  S,  o $i  = (T  $,)  o (T  $z) 

= $,'  (1]  9,  = $,  o 9, 

(2)  s,  O s2  ® S3  = (T  ?,)  O (T  $,)  0 (T  $3) 

Proof:  (T  $,)  o (T  $z)  ® (T  $3)  = (T  $|)  0 T ($2  ® $3) 

= S,  T 0 T ($2  ® $3)  = $,  [1]  (S2  0 $3) 

= $,  0 $2  O $3 


6.  Proof  of  J [Jd#0]  = [ (Jjd0)  ® ] 

[Jd*0]  = [ (E$td#|)©]  = SIS.d*,®] 

J"  [Jdrf®]  = £ J [$,<W,®] 

If  f [ S,d#,0  ] = [ <J$,d*,)  ® J,  then 

f [Jdtf®]  = S [ J J0  = [ (2  Js.dtf,  )®J 

- [ ( Js$,a*,  )0]  - [ (Jjd#)  ® ] 

Proof  of  J [$0]  d*  = t (J$d0)  0 ] 


f [S®]d# 


Jzd# 

-Jyd# 


-Jzdtf  -J  yd0  1 

0 Jxd# 

Jxd#  0 J 

J[s0xjd*  = [ (Js0d«)  x] 


r J[sx]d*  03 
l J[sox]d0  Jtsxjdtf 


[•  [(Jsdtf)x]  o3 

l [ (Jsod^)X)  [(Jsdtf)X] 


Proof  of  J 0.  Atf]  d(A$)  =0.5  [J„  hi]  A#  + .. 

Let  us  write  hi  = iht  + 0.5  iht!  + 

f 0.  A#]  d(A$)  = f [J„  (iht  + 0.5  iht!  + 

= f 0.  Ht  Atdt  + 0.5  J [}.  i]i  At2dt  + 
= 0.5  [J.  *]*  At2  + 


)]  «dt 


Substituting  0At  = - o.5  0At‘  + into  the  above 

equation  yields 

/ [J.  d(A#)]  A#  = 0.5  [J.  A#]  A*  + 

Since  all  the  terms  in  [J„A0]A#  are  of  second  order  in  A#, 
[j„A#]A0  is  denoted  by 


8.  Proof  of  the  statement  (page  93)  "the  auxiliary  matrix  a has 
to  be  of  rank  n in  order  to  keep  (AT0J)  nonsingular." 

A and  J are  of  dimension  6xn,  (n<6) , then  (AoJ)  is  of 
dimension  nxn.  "(AT©J)  is  nonsingular"  is  equivalent  to  "the 
rank  of  (a'oj)  is  n."  In  this  case  one  need  to  prove  that  when 
the  rank  of  A is  equal  to  n,  the  rank  of  (a'oj)  is  equal  to  the 
rank  of  J;  then  when  the  rank  of  J is  n,  (a'oj)  is  nonsingular. 

the  corresponding  statement  about  the  rank  of  a dot  product 
of  two  matrices  A and  B can  be  found  in  many  text  books. 

Denote  the  rank  of  a matrix  A by  r(A) , then 

(1)  r ( AB)  < min(  r(A),  r(B)  ) 

(2)  If  A is  nonsingular,  then  r (AB)  = r(B) 

The  counterparts  of  (l)  and  (2)  for  the  reciprocal  product 
of  matrices  are 

(1)  r (a'oJ)  < min(  r(A) , r(J)  ) 

(2)  If  A is  nonsingular,  then  r(A'oJ)  = r(J) 

Proof  of  r(A'oJ)  £ min(  r(A),  r(J)  ) 

r(A'oJ)  = r(A'[l]J)  = r(  A1  ( [1] J)  ) < r(A')  = r(A) 


rfA'oJ)  = r(AT[l]J)  = r(  (AT[1])  J ) £ r(J) 

Therefore, 

r (a'oj)  < min(  r(A),  r(J)  } 

Proof  of  "If  A is  nonsingular,  then  r(A'oJ)  = r(J)" 

J = { <tl]»)  ([l]A)-‘  }'  J - {{[llA)'1)1  ((!]»)'  J 

= l(tl)»r‘)T  (a'oj) 

Hence,  r(J)  < r(A'oJ) 

Also  one  has  r (a'oj)  <r (J) . Combining  these  two  results,  yields 
r (a'oj)  = r(J)  when  A is  nonsingular. 


of  associativity  of  matrix  multiplication  w 
x reciprocal  product  is  involved 


The  reciprocal  product  o cai 
"reciprocal  identity  matrix  [1]" 


a represented  by  the 


Hence,  the  reciprocal  product  of  two  vectors  $,  and  $2,  $,o$2  is 
exactly  the  same  as  $• 


,[!]$*• 


By  using  the  associativity  of  the  regular  matrix  dot 
product,  yields 

( A B ) O C = ( A B ) [1]  C = A ( B [1]  C ) 


Therefore,  one  can  obtain 

(AU)T  0 (BV)  = (AU)'  [1]  (BV)  = ( oV  ) [1]  ( BV  ) 

= O1  (AT[1]B)  V = 01  (ATOB)  V 
The  detailed  verification  of  the  above  equation  is  given  in 
following. 

In  order  to  apply  o operation,  the  number  of  rows  in  the 
matrices  (AO)  and  (BV)  must  be  6;  hence  (AO)  is  of  dimension  of 
6xm,  and  (BV)  is  of  dimension  of  6xn. 

uk«m  = [ Uj  u?  . . . Up,  ] where  ui  is  of  kxl, 

V,.„  = [ v,  Vj  . . . vn  ) where  v,  is  of  txi. 


au.  ]'  o [ BV,  BV; 


(AU,)'o(BV,)  (AU,)T0(BVj)  . . . 

(AUjj'olBV,)  (AU2),0(BV2)  . . . 

(AUp,)  '©  (BV,)  (AU.j'ofBV;)  . . . 


(AU,)'G(Bvn) 

(AUz)T0(BV„) 

(AU.pj'ofBVp) 


(A'oB) 


(a'oB)V,  (a'ob)- 


(a'oB)v„  ] 


U,'  (a'oBJV,  U,T(AT0B)Vj  ....  U|,(A,OB)Vn 

UjT(AT0B)V,  Uz'(»TOB)V2  ....  U2'(Ar0B)V„ 

^'(ft'oBJy,  u„'(A,0B)v2  ....  u„T(AfOB)Vn 


If  one  can  prove  that 

(AU,)  '©(BVj)  = U(T  (AT0B)  Vj 
then  (AO)1  0 (BV)  = DT  (a'oB)  V 


= (i^a,  + u^a*  + ...  + u^ajj'otuna,  + u12aj  + ...  + u^a,,) 
“ J * uih  vjp  »h°bD 


U,'  ( a'oB  ) Vj 


a, ob,  a,ob2 
a2sb,  a,ob2 


a;Ob( 
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